included calibrateCompass to the manualDrive menu

This commit is contained in:
2023-05-23 23:55:09 +02:00
parent 7e460e04b0
commit 2c1aed89f1
6 changed files with 71 additions and 4 deletions
+9 -1
View File
@@ -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;
}
+2 -2
View File
@@ -16,7 +16,6 @@
class CalibrateCompass {
public:
enum State {
None,
Ready,
Calibrating,
Finished
@@ -31,6 +30,7 @@ class CalibrateCompass {
void loop();
void start();
void useData();
void resetData();
void reset();
State getState() const { return this->state; }
@@ -38,7 +38,7 @@ class CalibrateCompass {
private:
QMC5883LCompass* compass;
State state = State::None;
State state;
CallibrationData data;
void clearData();