included calibrateCompass to the manualDrive menu
This commit is contained in:
@@ -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;
|
||||
}
|
||||
|
||||
|
||||
@@ -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();
|
||||
|
||||
Reference in New Issue
Block a user