included calibrateCompass to the manualDrive menu

2023-05-23 23:55:09 +02:00
parent 7e460e04b0
commit 2c1aed89f1
6 changed files with 71 additions and 4 deletions
@@ -66,6 +66,9 @@ void CalibrateCompass::loop() {
 }

 void CalibrateCompass::start() {
+    if (this->state != State::Ready)
+        return;
+
    this->clearData();
    this->state = State::Calibrating;
    this->compass->setCalibration(0, 0, 0, 0, 0, 0);
@@ -85,8 +88,13 @@ void CalibrateCompass::useData() {
                                    )
 }

+void CalibrateCompass::resetData() {
+    this->reset();
+    this->compass->setCalibration(0, 0, 0, 0, 0, 0);
+}
+
 void CalibrateCompass::reset() {
-    this->start();
+    this->clearData();
    this->state = State::Ready;
 }