mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-19 06:15:16 +03:00
Added calibration menu to CMS.
This commit is contained in:
parent
c6e5882dd9
commit
cedcf2d7e2
41 changed files with 387 additions and 143 deletions
|
@ -100,8 +100,8 @@ TEST(SensorGyro, Calibrate)
|
|||
EXPECT_EQ(9, gyroDevPtr->gyroZero[Y]);
|
||||
EXPECT_EQ(10, gyroDevPtr->gyroZero[Z]);
|
||||
gyroStartCalibration(false);
|
||||
EXPECT_EQ(false, isGyroCalibrationComplete());
|
||||
while (!isGyroCalibrationComplete()) {
|
||||
EXPECT_EQ(false, gyroIsCalibrationComplete());
|
||||
while (!gyroIsCalibrationComplete()) {
|
||||
gyroDevPtr->readFn(gyroDevPtr);
|
||||
performGyroCalibration(gyroSensorPtr, gyroMovementCalibrationThreshold);
|
||||
}
|
||||
|
@ -121,16 +121,16 @@ TEST(SensorGyro, Update)
|
|||
gyroInit();
|
||||
gyroDevPtr->readFn = fakeGyroRead;
|
||||
gyroStartCalibration(false);
|
||||
EXPECT_EQ(false, isGyroCalibrationComplete());
|
||||
EXPECT_EQ(false, gyroIsCalibrationComplete());
|
||||
|
||||
timeUs_t currentTimeUs = 0;
|
||||
fakeGyroSet(gyroDevPtr, 5, 6, 7);
|
||||
gyroUpdate(currentTimeUs);
|
||||
while (!isGyroCalibrationComplete()) {
|
||||
while (!gyroIsCalibrationComplete()) {
|
||||
fakeGyroSet(gyroDevPtr, 5, 6, 7);
|
||||
gyroUpdate(currentTimeUs);
|
||||
}
|
||||
EXPECT_EQ(true, isGyroCalibrationComplete());
|
||||
EXPECT_EQ(true, gyroIsCalibrationComplete());
|
||||
EXPECT_EQ(5, gyroDevPtr->gyroZero[X]);
|
||||
EXPECT_EQ(6, gyroDevPtr->gyroZero[Y]);
|
||||
EXPECT_EQ(7, gyroDevPtr->gyroZero[Z]);
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue