Commented some printf that could cause some shootty stuff
This commit is contained in:
parent
169f7c1103
commit
590ced4bd5
|
@ -79,9 +79,9 @@ void gyro_calibrate(void)
|
||||||
robot.gyro_data.y_offset = (float)y_sum / (float)nb_samples * DPS_PER_DIGIT;
|
robot.gyro_data.y_offset = (float)y_sum / (float)nb_samples * DPS_PER_DIGIT;
|
||||||
robot.gyro_data.z_offset = (float)z_sum / (float)nb_samples * DPS_PER_DIGIT;
|
robot.gyro_data.z_offset = (float)z_sum / (float)nb_samples * DPS_PER_DIGIT;
|
||||||
|
|
||||||
printf("\nx_cal:%.5f\n", robot.gyro_data.x_offset);
|
//printf("\nx_cal:%.5f\n", robot.gyro_data.x_offset);
|
||||||
printf("\ny_cal:%.5f\n", robot.gyro_data.y_offset);
|
//printf("\ny_cal:%.5f\n", robot.gyro_data.y_offset);
|
||||||
printf("\nz_cal:%.5f\n", robot.gyro_data.z_offset);
|
//printf("\nz_cal:%.5f\n", robot.gyro_data.z_offset);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void __attribute__((always_inline)) gyro_get_dps(double* x_dps, double* y_dps, double* z_dps)
|
static inline void __attribute__((always_inline)) gyro_get_dps(double* x_dps, double* y_dps, double* z_dps)
|
||||||
|
@ -120,9 +120,9 @@ void gyro_update(void)
|
||||||
while(robot.gyro_data.z_angle > 180) robot.gyro_data.z_angle -= 360;
|
while(robot.gyro_data.z_angle > 180) robot.gyro_data.z_angle -= 360;
|
||||||
while(robot.gyro_data.z_angle < -180) robot.gyro_data.z_angle += 360;
|
while(robot.gyro_data.z_angle < -180) robot.gyro_data.z_angle += 360;
|
||||||
|
|
||||||
printf(">gyro_x_angle:%f\n", robot.gyro_data.x_angle);
|
//printf(">gyro_x_angle:%f\n", robot.gyro_data.x_angle);
|
||||||
printf(">gyro_y_angle:%f\n", robot.gyro_data.y_angle);
|
//printf(">gyro_y_angle:%f\n", robot.gyro_data.y_angle);
|
||||||
printf(">gyro_z_angle:%f\n", robot.gyro_data.z_angle);
|
//printf(">gyro_z_angle:%f\n", robot.gyro_data.z_angle);
|
||||||
|
|
||||||
elapsed_since_sample_ms = 0.0;
|
elapsed_since_sample_ms = 0.0;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue