Browse Source
This wasn't actually responsible for saving offsets any more. The data spewed out was rather unlikely to be seen, and will be present in logs anyway.c415-sdk
Peter Barker
5 years ago
committed by
Randy Mackay
3 changed files with 0 additions and 83 deletions
@ -1,74 +0,0 @@
@@ -1,74 +0,0 @@
|
||||
#include "Copter.h" |
||||
|
||||
// report_compass - displays compass information. Also called by compassmot.pde
|
||||
void Copter::report_compass() |
||||
{ |
||||
hal.console->printf("Compass\n"); |
||||
print_divider(); |
||||
|
||||
print_enabled(AP::compass().enabled()); |
||||
|
||||
// mag declination
|
||||
hal.console->printf("Mag Dec: %4.4f\n", |
||||
(double)degrees(compass.get_declination())); |
||||
|
||||
// mag offsets
|
||||
Vector3f offsets; |
||||
for (uint8_t i=0; i<compass.get_count(); i++) { |
||||
offsets = compass.get_offsets(i); |
||||
// mag offsets
|
||||
hal.console->printf("Mag%d off: %4.4f, %4.4f, %4.4f\n", |
||||
(int)i, |
||||
(double)offsets.x, |
||||
(double)offsets.y, |
||||
(double)offsets.z); |
||||
} |
||||
|
||||
// motor compensation
|
||||
hal.console->printf("Motor Comp: "); |
||||
if( compass.get_motor_compensation_type() == AP_COMPASS_MOT_COMP_DISABLED ) { |
||||
hal.console->printf("Off\n"); |
||||
}else{ |
||||
if( compass.get_motor_compensation_type() == AP_COMPASS_MOT_COMP_THROTTLE ) { |
||||
hal.console->printf("Throttle"); |
||||
} |
||||
if( compass.get_motor_compensation_type() == AP_COMPASS_MOT_COMP_CURRENT ) { |
||||
hal.console->printf("Current"); |
||||
} |
||||
Vector3f motor_compensation; |
||||
for (uint8_t i=0; i<compass.get_count(); i++) { |
||||
motor_compensation = compass.get_motor_compensation(i); |
||||
hal.console->printf("\nComMot%d: %4.2f, %4.2f, %4.2f\n", |
||||
(int)i, |
||||
(double)motor_compensation.x, |
||||
(double)motor_compensation.y, |
||||
(double)motor_compensation.z); |
||||
} |
||||
} |
||||
print_blanks(1); |
||||
} |
||||
|
||||
void Copter::print_blanks(int16_t num) |
||||
{ |
||||
while(num > 0) { |
||||
num--; |
||||
hal.console->printf("\n"); |
||||
} |
||||
} |
||||
|
||||
void Copter::print_divider(void) |
||||
{ |
||||
for (int i = 0; i < 40; i++) { |
||||
hal.console->printf("-"); |
||||
} |
||||
hal.console->printf("\n"); |
||||
} |
||||
|
||||
void Copter::print_enabled(bool b) |
||||
{ |
||||
if(b) |
||||
hal.console->printf("en"); |
||||
else |
||||
hal.console->printf("dis"); |
||||
hal.console->printf("abled\n"); |
||||
} |
Loading…
Reference in new issue