Added waiting before calibrating gyro
This commit is contained in:
parent
7e3b0e7a9d
commit
1c24cac767
|
@ -38,6 +38,8 @@ int init_gyro(void)
|
|||
robot.gyro_data.y_angle = 0.0f;
|
||||
robot.gyro_data.z_angle = 0.0f;
|
||||
|
||||
sleep_ms(1000);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
@ -55,7 +57,7 @@ static inline void __attribute__((always_inline)) gyro_read(int16_t *x, int16_t
|
|||
|
||||
void gyro_calibrate(void)
|
||||
{
|
||||
const uint nb_samples = 10000;
|
||||
const uint nb_samples = 1000;
|
||||
|
||||
int16_t x, y, z;
|
||||
int32_t x_sum = 0, y_sum = 0, z_sum = 0;
|
||||
|
|
Loading…
Reference in New Issue