yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 09:28:58 +00:00
Code Issues Packages Projects Releases Wiki Activity

Restore proper feedback (mavlink and tone) for calibration commands, etc

Browse Source
This commit is contained in:
Julian Oes
2013-08-22 15:57:17 +02:00
parent 6c3da5aedd
commit 5f1004117f
13 changed files with 179 additions and 136 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/modules/commander/accelerometer_calibration.cpp
View File

@@ -133,7 +133,7 @@ int read_accelerometer_avg(int sensor_combined_sub, float accel_avg[3], int samp
int mat_invert3(float src[3][3], float dst[3][3]);
int calculate_calibration_values(float accel_ref[6][3], float accel_T[3][3], float accel_offs[3], float g);
void do_accel_calibration(int mavlink_fd) {
int do_accel_calibration(int mavlink_fd) {
/* announce change */
mavlink_log_info(mavlink_fd, "accel calibration started");
@@ -176,11 +176,11 @@ void do_accel_calibration(int mavlink_fd) {
}
mavlink_log_info(mavlink_fd, "accel calibration done");
tune_positive();
return OK;
} else {
/* measurements error */
mavlink_log_info(mavlink_fd, "accel calibration aborted");
tune_negative();
return ERROR;
}
/* exit accel calibration mode */