mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-21 07:13:56 -04:00
AP_Compass: remove use of milligauss_ratio
Now, we have all current compasses publishing their values already in milligauss, so there's no need for that variable anymore.
This commit is contained in:
parent
b603641d7c
commit
9927cf066f
@ -180,8 +180,6 @@ bool AP_Compass_AK8963::init()
|
|||||||
set_dev_id(_compass_instance, _bus->get_dev_id());
|
set_dev_id(_compass_instance, _bus->get_dev_id());
|
||||||
hal.scheduler->register_timer_process(FUNCTOR_BIND_MEMBER(&AP_Compass_AK8963::_update, void));
|
hal.scheduler->register_timer_process(FUNCTOR_BIND_MEMBER(&AP_Compass_AK8963::_update, void));
|
||||||
|
|
||||||
set_milligauss_ratio(_compass_instance, 1.0f);
|
|
||||||
|
|
||||||
_bus_sem->give();
|
_bus_sem->give();
|
||||||
hal.scheduler->resume_timer_procs();
|
hal.scheduler->resume_timer_procs();
|
||||||
|
|
||||||
|
@ -141,9 +141,3 @@ void AP_Compass_Backend::set_external(uint8_t instance, bool external)
|
|||||||
{
|
{
|
||||||
_compass._state[instance].external.set(external);
|
_compass._state[instance].external.set(external);
|
||||||
}
|
}
|
||||||
|
|
||||||
// set ratio to convert to milligauss
|
|
||||||
void AP_Compass_Backend::set_milligauss_ratio(uint8_t instance, float ratio)
|
|
||||||
{
|
|
||||||
_compass._state[instance].milligauss_ratio = ratio;
|
|
||||||
}
|
|
||||||
|
@ -73,9 +73,6 @@ protected:
|
|||||||
// set external state for an instance
|
// set external state for an instance
|
||||||
void set_external(uint8_t instance, bool external);
|
void set_external(uint8_t instance, bool external);
|
||||||
|
|
||||||
// set ratio to convert to milligauss
|
|
||||||
void set_milligauss_ratio(uint8_t instance, float ratio);
|
|
||||||
|
|
||||||
// access to frontend
|
// access to frontend
|
||||||
Compass &_compass;
|
Compass &_compass;
|
||||||
|
|
||||||
|
@ -53,7 +53,6 @@ AP_Compass_HIL::init(void)
|
|||||||
// register two compass instances
|
// register two compass instances
|
||||||
for (uint8_t i=0; i<HIL_NUM_COMPASSES; i++) {
|
for (uint8_t i=0; i<HIL_NUM_COMPASSES; i++) {
|
||||||
_compass_instance[i] = register_compass();
|
_compass_instance[i] = register_compass();
|
||||||
set_milligauss_ratio(_compass_instance[i], 1.0f);
|
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
@ -332,8 +332,6 @@ AP_Compass_HMC5843::init()
|
|||||||
_compass_instance = register_compass();
|
_compass_instance = register_compass();
|
||||||
set_dev_id(_compass_instance, _product_id);
|
set_dev_id(_compass_instance, _product_id);
|
||||||
|
|
||||||
set_milligauss_ratio(_compass_instance, 1.0f);
|
|
||||||
|
|
||||||
#if CONFIG_HAL_BOARD == HAL_BOARD_LINUX && CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_RASPILOT
|
#if CONFIG_HAL_BOARD == HAL_BOARD_LINUX && CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_RASPILOT
|
||||||
set_external(_compass_instance, true);
|
set_external(_compass_instance, true);
|
||||||
#endif
|
#endif
|
||||||
|
@ -341,8 +341,6 @@ AP_Compass_LSM303D::init()
|
|||||||
|
|
||||||
hal.scheduler->register_timer_process(FUNCTOR_BIND_MEMBER(&AP_Compass_LSM303D::_update, void));
|
hal.scheduler->register_timer_process(FUNCTOR_BIND_MEMBER(&AP_Compass_LSM303D::_update, void));
|
||||||
|
|
||||||
set_milligauss_ratio(_compass_instance, 1.0f);
|
|
||||||
|
|
||||||
_spi_sem->give();
|
_spi_sem->give();
|
||||||
hal.scheduler->resume_timer_procs();
|
hal.scheduler->resume_timer_procs();
|
||||||
_initialised = true;
|
_initialised = true;
|
||||||
|
@ -96,7 +96,6 @@ bool AP_Compass_PX4::init(void)
|
|||||||
_count[i] = 0;
|
_count[i] = 0;
|
||||||
_sum[i].zero();
|
_sum[i].zero();
|
||||||
|
|
||||||
set_milligauss_ratio(_instance[i], 1.0f);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// give the driver a chance to run, and gather one sample
|
// give the driver a chance to run, and gather one sample
|
||||||
|
@ -119,7 +119,7 @@ public:
|
|||||||
uint8_t get_count(void) const { return _compass_count; }
|
uint8_t get_count(void) const { return _compass_count; }
|
||||||
|
|
||||||
/// Return the current field as a Vector3f
|
/// Return the current field as a Vector3f
|
||||||
const Vector3f &get_field(uint8_t i) const { return _state[i].field * _state[i].milligauss_ratio; }
|
const Vector3f &get_field(uint8_t i) const { return _state[i].field; }
|
||||||
const Vector3f &get_field(void) const { return get_field(get_primary()); }
|
const Vector3f &get_field(void) const { return get_field(get_primary()); }
|
||||||
|
|
||||||
// raw/unfiltered measurement interface
|
// raw/unfiltered measurement interface
|
||||||
@ -180,7 +180,7 @@ public:
|
|||||||
///
|
///
|
||||||
/// @returns The current compass offsets.
|
/// @returns The current compass offsets.
|
||||||
///
|
///
|
||||||
const Vector3f &get_offsets(uint8_t i) const { return _state[i].offset * _state[i].milligauss_ratio; }
|
const Vector3f &get_offsets(uint8_t i) const { return _state[i].offset; }
|
||||||
const Vector3f &get_offsets(void) const { return get_offsets(get_primary()); }
|
const Vector3f &get_offsets(void) const { return get_offsets(get_primary()); }
|
||||||
|
|
||||||
/// Sets the initial location used to get declination
|
/// Sets the initial location used to get declination
|
||||||
@ -391,7 +391,6 @@ private:
|
|||||||
|
|
||||||
// corrected magnetic field strength
|
// corrected magnetic field strength
|
||||||
Vector3f field;
|
Vector3f field;
|
||||||
float milligauss_ratio;
|
|
||||||
|
|
||||||
// when we last got data
|
// when we last got data
|
||||||
uint32_t last_update_ms;
|
uint32_t last_update_ms;
|
||||||
|
Loading…
Reference in New Issue
Block a user