DataFlash: use compass get_{field,offsets}() functions
Both functions are equivalent, so we're going to simply use get_{field,offsets}() instead of get_{field,offsets}_milligauss().
This commit is contained in:
parent
2cc07d2899
commit
363f9cf82a
@ -1537,7 +1537,7 @@ void DataFlash_Class::Log_Write_Current(const AP_BattMonitor &battery, int16_t t
|
|||||||
// Write a Compass packet
|
// Write a Compass packet
|
||||||
void DataFlash_Class::Log_Write_Compass(const Compass &compass)
|
void DataFlash_Class::Log_Write_Compass(const Compass &compass)
|
||||||
{
|
{
|
||||||
const Vector3f &mag_field = compass.get_field_milligauss(0);
|
const Vector3f &mag_field = compass.get_field(0);
|
||||||
const Vector3f &mag_offsets = compass.get_offsets(0);
|
const Vector3f &mag_offsets = compass.get_offsets(0);
|
||||||
const Vector3f &mag_motor_offsets = compass.get_motor_offsets(0);
|
const Vector3f &mag_motor_offsets = compass.get_motor_offsets(0);
|
||||||
struct log_Compass pkt = {
|
struct log_Compass pkt = {
|
||||||
@ -1580,7 +1580,7 @@ void DataFlash_Class::Log_Write_Compass(const Compass &compass)
|
|||||||
#endif
|
#endif
|
||||||
#if COMPASS_MAX_INSTANCES > 2
|
#if COMPASS_MAX_INSTANCES > 2
|
||||||
if (compass.get_count() > 2) {
|
if (compass.get_count() > 2) {
|
||||||
const Vector3f &mag_field3 = compass.get_field_milligauss(2);
|
const Vector3f &mag_field3 = compass.get_field(2);
|
||||||
const Vector3f &mag_offsets3 = compass.get_offsets(2);
|
const Vector3f &mag_offsets3 = compass.get_offsets(2);
|
||||||
const Vector3f &mag_motor_offsets3 = compass.get_motor_offsets(2);
|
const Vector3f &mag_motor_offsets3 = compass.get_motor_offsets(2);
|
||||||
struct log_Compass pkt3 = {
|
struct log_Compass pkt3 = {
|
||||||
|
Loading…
Reference in New Issue
Block a user