Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Copter: remove report_compass method 

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.
This commit is contained in:
Peter Barker 2020-01-02 10:38:03 +11:00 committed by Randy Mackay
parent 2694560c38
commit 1ff07762de
3 changed files with 0 additions and 83 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
ArduCopter/Copter.h
View File

@ -859,12 +859,6 @@ private:
void winch_init();
void winch_update();
// setup.cpp
void report_compass();
void print_blanks(int16_t num);
void print_divider(void);
void print_enabled(bool b);
// switches.cpp
void save_trim();
void auto_trim();

3
ArduCopter/compassmot.cpp
View File

@ -248,9 +248,6 @@ MAV_RESULT Copter::mavlink_compassmot(const GCS_MAVLINK &gcs_chan)
compass.motor_compensation_type(AP_COMPASS_MOT_COMP_DISABLED);
}
// display new motor offsets and save
report_compass();
// turn off notify leds
AP_Notify::flags.esc_calibration = false;

74
ArduCopter/setup.cpp
View File

@ -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");
}