forked from Archive/PX4-Autopilot
Compare commits
2 Commits
main
...
pr-remove_
Author | SHA1 | Date |
---|---|---|
mcsauder | f16ef917f7 | |
mcsauder | 61b3b482a8 |
|
@ -4,10 +4,11 @@ uint64 timestamp_sample
|
||||||
uint32 device_id # unique device ID for the sensor that does not change between power cycles
|
uint32 device_id # unique device ID for the sensor that does not change between power cycles
|
||||||
|
|
||||||
float32 dt # delta time between samples (microseconds)
|
float32 dt # delta time between samples (microseconds)
|
||||||
float32 scale
|
|
||||||
|
|
||||||
uint8 samples # number of valid samples
|
uint8 samples # number of valid samples
|
||||||
|
|
||||||
int16[32] x # acceleration in the FRD board frame X-axis in m/s^2
|
int16[32] x # acceleration in the FRD board frame X-axis in m/s^2
|
||||||
int16[32] y # acceleration in the FRD board frame Y-axis in m/s^2
|
int16[32] y # acceleration in the FRD board frame Y-axis in m/s^2
|
||||||
int16[32] z # acceleration in the FRD board frame Z-axis in m/s^2
|
int16[32] z # acceleration in the FRD board frame Z-axis in m/s^2
|
||||||
|
|
||||||
|
uint8 ORB_QUEUE_LENGTH = 4
|
||||||
|
|
|
@ -145,7 +145,6 @@ void PX4Accelerometer::updateFIFO(sensor_accel_fifo_s &sample)
|
||||||
}
|
}
|
||||||
|
|
||||||
sample.device_id = _device_id;
|
sample.device_id = _device_id;
|
||||||
sample.scale = _scale;
|
|
||||||
sample.timestamp = hrt_absolute_time();
|
sample.timestamp = hrt_absolute_time();
|
||||||
_sensor_fifo_pub.publish(sample);
|
_sensor_fifo_pub.publish(sample);
|
||||||
|
|
||||||
|
|
|
@ -144,11 +144,9 @@ void PX4Gyroscope::updateFIFO(sensor_gyro_fifo_s &sample)
|
||||||
}
|
}
|
||||||
|
|
||||||
sample.device_id = _device_id;
|
sample.device_id = _device_id;
|
||||||
sample.scale = _scale;
|
|
||||||
sample.timestamp = hrt_absolute_time();
|
sample.timestamp = hrt_absolute_time();
|
||||||
_sensor_fifo_pub.publish(sample);
|
_sensor_fifo_pub.publish(sample);
|
||||||
|
|
||||||
|
|
||||||
// publish
|
// publish
|
||||||
sensor_gyro_s report;
|
sensor_gyro_s report;
|
||||||
report.timestamp_sample = sample.timestamp_sample;
|
report.timestamp_sample = sample.timestamp_sample;
|
||||||
|
|
|
@ -840,7 +840,7 @@ void VehicleAngularVelocity::Run()
|
||||||
float data[FIFO_SIZE_MAX];
|
float data[FIFO_SIZE_MAX];
|
||||||
|
|
||||||
for (int n = 0; n < N; n++) {
|
for (int n = 0; n < N; n++) {
|
||||||
data[n] = sensor_fifo_data.scale * raw_data_array[axis][n];
|
data[n] = raw_data_array[axis][n];
|
||||||
}
|
}
|
||||||
|
|
||||||
// save last filtered sample
|
// save last filtered sample
|
||||||
|
|
Loading…
Reference in New Issue