mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-25 08:36:08 +08:00
delete accel_report (alias for sensor_accel_s)
This commit is contained in:
committed by
Lorenz Meier
parent
22c9fb7290
commit
2a83a40491
@@ -52,7 +52,6 @@
|
||||
#define ACCEL2_DEVICE_PATH "/dev/accel2"
|
||||
|
||||
#include <uORB/topics/sensor_accel.h>
|
||||
#define accel_report sensor_accel_s
|
||||
|
||||
/** accel scaling factors; Vout = Vscale * (Vin + Voffset) */
|
||||
struct accel_calibration_s {
|
||||
|
||||
@@ -603,7 +603,7 @@ ADIS16448::init()
|
||||
goto out;
|
||||
}
|
||||
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -665,7 +665,7 @@ ADIS16448::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -841,7 +841,7 @@ ADIS16448::_set_gyro_dyn_range(uint16_t desired_gyro_dyn_range)
|
||||
ssize_t
|
||||
ADIS16448::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -862,7 +862,7 @@ ADIS16448::read(struct file *filp, char *buffer, size_t buflen)
|
||||
perf_count(_accel_reads);
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -875,7 +875,7 @@ ADIS16448::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -1353,7 +1353,7 @@ ADIS16448::measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb;
|
||||
sensor_accel_s arb;
|
||||
gyro_report grb;
|
||||
mag_report mrb;
|
||||
|
||||
@@ -1750,7 +1750,7 @@ fail:
|
||||
void
|
||||
test()
|
||||
{
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
mag_report m_report;
|
||||
|
||||
|
||||
@@ -200,7 +200,7 @@ ADIS16477::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
accel_report arp = {};
|
||||
sensor_accel_s arp = {};
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
_accel_topic = orb_advertise_multi(ORB_ID(sensor_accel), &arp, &_accel_orb_class_instance, ORB_PRIO_MAX);
|
||||
@@ -593,7 +593,7 @@ ADIS16477::measure()
|
||||
bool
|
||||
ADIS16477::publish_accel(const ADISReport &report)
|
||||
{
|
||||
accel_report arb = {};
|
||||
sensor_accel_s arb = {};
|
||||
arb.timestamp = hrt_absolute_time();
|
||||
arb.device_id = _device_id.devid;
|
||||
arb.error_count = perf_event_count(_bad_transfers);
|
||||
|
||||
@@ -113,7 +113,7 @@ fail:
|
||||
void
|
||||
test()
|
||||
{
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
|
||||
ssize_t sz;
|
||||
|
||||
@@ -278,7 +278,7 @@ BMA180::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -325,7 +325,7 @@ BMA180::init()
|
||||
measure();
|
||||
|
||||
if (_class_instance == CLASS_DEVICE_PRIMARY) {
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -352,8 +352,8 @@ BMA180::probe()
|
||||
ssize_t
|
||||
BMA180::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(struct accel_report);
|
||||
struct accel_report *arp = reinterpret_cast<struct accel_report *>(buffer);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int ret = 0;
|
||||
|
||||
/* buffer must be large enough */
|
||||
@@ -661,7 +661,7 @@ BMA180::measure()
|
||||
// } raw_report;
|
||||
// #pragma pack(pop)
|
||||
|
||||
struct accel_report report;
|
||||
sensor_accel_s report;
|
||||
|
||||
/* start the performance counter */
|
||||
perf_begin(_sample_perf);
|
||||
@@ -796,7 +796,7 @@ void
|
||||
test()
|
||||
{
|
||||
int fd = -1;
|
||||
struct accel_report a_report;
|
||||
sensor_accel_s a_report;
|
||||
ssize_t sz;
|
||||
|
||||
/* get the driver */
|
||||
|
||||
@@ -116,7 +116,7 @@ BMI055_accel::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -139,7 +139,7 @@ BMI055_accel::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -262,7 +262,7 @@ BMI055_accel::accel_set_sample_rate(float frequency)
|
||||
ssize_t
|
||||
BMI055_accel::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -281,7 +281,7 @@ BMI055_accel::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -294,7 +294,7 @@ BMI055_accel::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -671,7 +671,7 @@ BMI055_accel::measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb;
|
||||
sensor_accel_s arb;
|
||||
|
||||
arb.timestamp = hrt_absolute_time();
|
||||
|
||||
|
||||
@@ -225,7 +225,7 @@ test(bool external_bus, enum sensor_type sensor)
|
||||
{
|
||||
const char *path_accel = external_bus ? BMI055_DEVICE_PATH_ACCEL_EXT : BMI055_DEVICE_PATH_ACCEL;
|
||||
const char *path_gyro = external_bus ? BMI055_DEVICE_PATH_GYRO_EXT : BMI055_DEVICE_PATH_GYRO;
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
ssize_t sz;
|
||||
|
||||
|
||||
@@ -138,7 +138,7 @@ BMI160::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -184,7 +184,7 @@ BMI160::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -444,7 +444,7 @@ BMI160::_set_dlpf_filter(uint16_t bandwidth)
|
||||
ssize_t
|
||||
BMI160::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -465,7 +465,7 @@ BMI160::read(struct file *filp, char *buffer, size_t buflen)
|
||||
perf_count(_accel_reads);
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -478,7 +478,7 @@ BMI160::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -1043,7 +1043,7 @@ BMI160::measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb;
|
||||
sensor_accel_s arb{};
|
||||
gyro_report grb;
|
||||
|
||||
/*
|
||||
|
||||
@@ -121,7 +121,7 @@ test(bool external_bus)
|
||||
{
|
||||
const char *path_accel = external_bus ? BMI160_DEVICE_PATH_ACCEL_EXT : BMI160_DEVICE_PATH_ACCEL;
|
||||
const char *path_gyro = external_bus ? BMI160_DEVICE_PATH_GYRO_EXT : BMI160_DEVICE_PATH_GYRO;
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
ssize_t sz;
|
||||
|
||||
|
||||
@@ -582,7 +582,7 @@ FXOS8701CQ::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
return ret;
|
||||
@@ -643,7 +643,7 @@ FXOS8701CQ::init()
|
||||
_accel_class_instance = register_class_devname(ACCEL_BASE_DEVICE_PATH);
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -717,8 +717,8 @@ FXOS8701CQ::probe()
|
||||
ssize_t
|
||||
FXOS8701CQ::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(struct accel_report);
|
||||
accel_report *arb = reinterpret_cast<accel_report *>(buffer);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
sensor_accel_s *arb = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int ret = 0;
|
||||
|
||||
/* buffer must be large enough */
|
||||
@@ -1305,7 +1305,7 @@ FXOS8701CQ::measure()
|
||||
} raw_accel_mag_report;
|
||||
#pragma pack(pop)
|
||||
|
||||
accel_report accel_report;
|
||||
sensor_accel_s accel_report;
|
||||
|
||||
/* start the performance counter */
|
||||
perf_begin(_accel_sample_perf);
|
||||
@@ -1761,7 +1761,7 @@ test()
|
||||
{
|
||||
int rv = 1;
|
||||
int fd_accel = -1;
|
||||
struct accel_report accel_report;
|
||||
sensor_accel_s accel_report;
|
||||
ssize_t sz;
|
||||
#if !defined(BOARD_HAS_NOISY_FXOS8700_MAG)
|
||||
int fd_mag = -1;
|
||||
@@ -1778,9 +1778,9 @@ test()
|
||||
}
|
||||
|
||||
/* do a simple demand read */
|
||||
sz = read(fd_accel, &accel_report, sizeof(accel_report));
|
||||
sz = read(fd_accel, &accel_report, sizeof(sensor_accel_s));
|
||||
|
||||
if (sz != sizeof(accel_report)) {
|
||||
if (sz != sizeof(sensor_accel_s)) {
|
||||
PX4_ERR("immediate read failed");
|
||||
goto exit_with_accel;
|
||||
}
|
||||
|
||||
@@ -617,7 +617,7 @@ LSM303D::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -654,7 +654,7 @@ LSM303D::init()
|
||||
_accel_class_instance = register_class_devname(ACCEL_BASE_DEVICE_PATH);
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -731,8 +731,8 @@ LSM303D::probe()
|
||||
ssize_t
|
||||
LSM303D::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(struct accel_report);
|
||||
accel_report *arb = reinterpret_cast<accel_report *>(buffer);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
sensor_accel_s *arb = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int ret = 0;
|
||||
|
||||
/* buffer must be large enough */
|
||||
@@ -1370,7 +1370,7 @@ LSM303D::measure()
|
||||
} raw_accel_report;
|
||||
#pragma pack(pop)
|
||||
|
||||
accel_report accel_report;
|
||||
sensor_accel_s accel_report;
|
||||
|
||||
/* start the performance counter */
|
||||
perf_begin(_accel_sample_perf);
|
||||
@@ -1845,7 +1845,7 @@ void
|
||||
test()
|
||||
{
|
||||
int fd_accel = -1;
|
||||
struct accel_report accel_report;
|
||||
sensor_accel_s accel_report;
|
||||
ssize_t sz;
|
||||
int ret;
|
||||
|
||||
@@ -1857,9 +1857,9 @@ test()
|
||||
}
|
||||
|
||||
/* do a simple demand read */
|
||||
sz = read(fd_accel, &accel_report, sizeof(accel_report));
|
||||
sz = read(fd_accel, &accel_report, sizeof(sensor_accel_s));
|
||||
|
||||
if (sz != sizeof(accel_report)) {
|
||||
if (sz != sizeof(sensor_accel_s)) {
|
||||
err(1, "immediate read failed");
|
||||
}
|
||||
|
||||
|
||||
@@ -634,7 +634,7 @@ MPU6000::init()
|
||||
|
||||
ret = -ENOMEM;
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
return ret;
|
||||
@@ -706,7 +706,7 @@ MPU6000::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -1003,7 +1003,7 @@ MPU6000::_set_icm_acc_dlpf_filter(uint16_t frequency_hz)
|
||||
ssize_t
|
||||
MPU6000::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -1022,7 +1022,7 @@ MPU6000::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -1035,7 +1035,7 @@ MPU6000::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -1818,7 +1818,7 @@ MPU6000::measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb;
|
||||
sensor_accel_s arb;
|
||||
gyro_report grb;
|
||||
|
||||
/*
|
||||
@@ -2270,7 +2270,7 @@ void
|
||||
test(enum MPU6000_BUS busid)
|
||||
{
|
||||
struct mpu6000_bus_option &bus = find_bus(busid);
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
ssize_t sz;
|
||||
|
||||
|
||||
@@ -316,7 +316,7 @@ void
|
||||
test(enum MPU9250_BUS busid)
|
||||
{
|
||||
struct mpu9250_bus_option &bus = find_bus(busid);
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report{};
|
||||
gyro_report g_report;
|
||||
mag_report m_report;
|
||||
ssize_t sz;
|
||||
|
||||
@@ -288,7 +288,7 @@ MPU9250::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
ret = -ENOMEM;
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
@@ -390,7 +390,7 @@ MPU9250::init()
|
||||
measure();
|
||||
|
||||
/* advertise sensor topic, measure manually to initialize valid report */
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
_accel_reports->get(&arp);
|
||||
|
||||
/* measurement will have generated a report, publish */
|
||||
@@ -621,7 +621,7 @@ MPU9250::_set_dlpf_filter(uint16_t frequency_hz)
|
||||
ssize_t
|
||||
MPU9250::read(struct file *filp, char *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -642,7 +642,7 @@ MPU9250::read(struct file *filp, char *buffer, size_t buflen)
|
||||
perf_count(_accel_reads);
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -655,7 +655,7 @@ MPU9250::read(struct file *filp, char *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -1287,7 +1287,7 @@ MPU9250::measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb;
|
||||
sensor_accel_s arb{};
|
||||
gyro_report grb;
|
||||
|
||||
/*
|
||||
|
||||
@@ -183,8 +183,8 @@ int matlab_csv_serial_thread_main(int argc, char *argv[])
|
||||
}
|
||||
|
||||
/* subscribe to vehicle status, attitude, sensors and flow*/
|
||||
struct accel_report accel0;
|
||||
struct accel_report accel1;
|
||||
struct sensor_accel_s accel0;
|
||||
struct sensor_accel_s accel1;
|
||||
struct gyro_report gyro0;
|
||||
struct gyro_report gyro1;
|
||||
|
||||
|
||||
@@ -479,7 +479,7 @@ calibrate_return do_accel_calibration_measurements(orb_advert_t *mavlink_log_pub
|
||||
for(unsigned i = 0; i < orb_accel_count && !found_cur_accel; i++) {
|
||||
worker_data.subs[cur_accel] = orb_subscribe_multi(ORB_ID(sensor_accel), i);
|
||||
|
||||
struct accel_report report = {};
|
||||
sensor_accel_s report = {};
|
||||
orb_copy(ORB_ID(sensor_accel), worker_data.subs[cur_accel], &report);
|
||||
|
||||
#ifdef __PX4_NUTTX
|
||||
@@ -538,7 +538,7 @@ calibrate_return do_accel_calibration_measurements(orb_advert_t *mavlink_log_pub
|
||||
for (unsigned i = 0; i < max_accel_sens; i++) {
|
||||
if (worker_data.subs[i] >= 0) {
|
||||
/* figure out which sensors were active */
|
||||
struct accel_report arp = {};
|
||||
sensor_accel_s arp = {};
|
||||
(void)orb_copy(ORB_ID(sensor_accel), worker_data.subs[i], &arp);
|
||||
if (arp.timestamp != 0 && timestamps[i] != arp.timestamp) {
|
||||
(*active_sensors)++;
|
||||
@@ -626,7 +626,7 @@ calibrate_return read_accelerometer_avg(int sensor_correction_sub, int (&subs)[m
|
||||
|
||||
if (changed) {
|
||||
|
||||
struct accel_report arp;
|
||||
sensor_accel_s arp;
|
||||
orb_copy(ORB_ID(sensor_accel), subs[s], &arp);
|
||||
|
||||
// Apply thermal offset corrections in sensor/board frame
|
||||
|
||||
@@ -2068,7 +2068,7 @@ MavlinkReceiver::handle_message_hil_sensor(mavlink_message_t *msg)
|
||||
|
||||
/* accelerometer */
|
||||
{
|
||||
struct accel_report accel = {};
|
||||
sensor_accel_s accel = {};
|
||||
|
||||
accel.timestamp = timestamp;
|
||||
accel.x_raw = imu.xacc / (CONSTANTS_ONE_G / 1000.0f);
|
||||
@@ -2469,7 +2469,7 @@ MavlinkReceiver::handle_message_hil_state_quaternion(mavlink_message_t *msg)
|
||||
|
||||
/* accelerometer */
|
||||
{
|
||||
struct accel_report accel = {};
|
||||
sensor_accel_s accel = {};
|
||||
|
||||
accel.timestamp = timestamp;
|
||||
accel.x_raw = hil_state.xacc / CONSTANTS_ONE_G * 1e3f;
|
||||
|
||||
@@ -179,7 +179,7 @@ void VotedSensorsUpdate::parameters_update()
|
||||
|
||||
if (topic_instance < _accel.subscription_count) {
|
||||
// valid subscription, so get the driver id by getting the published sensor data
|
||||
struct accel_report report;
|
||||
sensor_accel_s report;
|
||||
|
||||
if (orb_copy(ORB_ID(sensor_accel), _accel.subscription[topic_instance], &report) == 0) {
|
||||
int temp = _temperature_compensation.set_sensor_id_accel(report.device_id, topic_instance);
|
||||
@@ -545,7 +545,7 @@ void VotedSensorsUpdate::accel_poll(struct sensor_combined_s &raw)
|
||||
orb_check(_accel.subscription[uorb_index], &accel_updated);
|
||||
|
||||
if (accel_updated) {
|
||||
struct accel_report accel_report;
|
||||
sensor_accel_s accel_report;
|
||||
|
||||
int ret = orb_copy(ORB_ID(sensor_accel), _accel.subscription[uorb_index], &accel_report);
|
||||
|
||||
|
||||
@@ -321,7 +321,7 @@ ACCELSIM::init()
|
||||
int ret = -1;
|
||||
|
||||
struct mag_report mrp = {};
|
||||
struct accel_report arp = {};
|
||||
sensor_accel_s arp = {};
|
||||
|
||||
/* do SIM init first */
|
||||
if (VirtDevObj::init() != 0) {
|
||||
@@ -330,7 +330,7 @@ ACCELSIM::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
goto out;
|
||||
@@ -410,8 +410,8 @@ ACCELSIM::transfer(uint8_t *send, uint8_t *recv, unsigned len)
|
||||
ssize_t
|
||||
ACCELSIM::devRead(void *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(struct accel_report);
|
||||
accel_report *arb = reinterpret_cast<accel_report *>(buffer);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
sensor_accel_s *arb = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int ret = 0;
|
||||
|
||||
/* buffer must be large enough */
|
||||
@@ -781,7 +781,7 @@ ACCELSIM::_measure()
|
||||
} raw_accel_report;
|
||||
#pragma pack(pop)
|
||||
|
||||
accel_report accel_report = {};
|
||||
sensor_accel_s accel_report = {};
|
||||
|
||||
/* start the performance counter */
|
||||
perf_begin(_accel_sample_perf);
|
||||
|
||||
@@ -363,7 +363,7 @@ GYROSIM::init()
|
||||
PX4_DEBUG("init");
|
||||
int ret = 1;
|
||||
|
||||
struct accel_report arp = {};
|
||||
sensor_accel_s arp = {};
|
||||
|
||||
struct gyro_report grp = {};
|
||||
|
||||
@@ -376,7 +376,7 @@ GYROSIM::init()
|
||||
}
|
||||
|
||||
/* allocate basic report buffers */
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(accel_report));
|
||||
_accel_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_accel_s));
|
||||
|
||||
if (_accel_reports == nullptr) {
|
||||
PX4_WARN("_accel_reports creation failed");
|
||||
@@ -536,7 +536,7 @@ GYROSIM::_set_sample_rate(unsigned desired_sample_rate_hz)
|
||||
ssize_t
|
||||
GYROSIM::devRead(void *buffer, size_t buflen)
|
||||
{
|
||||
unsigned count = buflen / sizeof(accel_report);
|
||||
unsigned count = buflen / sizeof(sensor_accel_s);
|
||||
|
||||
/* buffer must be large enough */
|
||||
if (count < 1) {
|
||||
@@ -557,7 +557,7 @@ GYROSIM::devRead(void *buffer, size_t buflen)
|
||||
perf_count(_accel_reads);
|
||||
|
||||
/* copy reports out of our buffer to the caller */
|
||||
accel_report *arp = reinterpret_cast<accel_report *>(buffer);
|
||||
sensor_accel_s *arp = reinterpret_cast<sensor_accel_s *>(buffer);
|
||||
int transferred = 0;
|
||||
|
||||
while (count--) {
|
||||
@@ -570,7 +570,7 @@ GYROSIM::devRead(void *buffer, size_t buflen)
|
||||
}
|
||||
|
||||
/* return the number of bytes transferred */
|
||||
return (transferred * sizeof(accel_report));
|
||||
return (transferred * sizeof(sensor_accel_s));
|
||||
}
|
||||
|
||||
int
|
||||
@@ -893,7 +893,7 @@ GYROSIM::_measure()
|
||||
/*
|
||||
* Report buffers.
|
||||
*/
|
||||
accel_report arb = {};
|
||||
sensor_accel_s arb = {};
|
||||
gyro_report grb = {};
|
||||
|
||||
// for now use local time but this should be the timestamp of the simulator
|
||||
@@ -1175,7 +1175,7 @@ test()
|
||||
{
|
||||
const char *path_accel = MPU_DEVICE_PATH_ACCEL;
|
||||
const char *path_gyro = MPU_DEVICE_PATH_GYRO;
|
||||
accel_report a_report;
|
||||
sensor_accel_s a_report;
|
||||
gyro_report g_report;
|
||||
ssize_t sz;
|
||||
|
||||
|
||||
@@ -1025,7 +1025,7 @@ int Simulator::publish_sensor_topics(mavlink_hil_sensor_t *imu)
|
||||
|
||||
/* accelerometer */
|
||||
{
|
||||
struct accel_report accel = {};
|
||||
sensor_accel_s accel = {};
|
||||
|
||||
accel.timestamp = timestamp;
|
||||
accel.x_raw = imu->xacc / (CONSTANTS_ONE_G / 1000.0f);
|
||||
|
||||
@@ -239,7 +239,7 @@ DfLsm9ds1Wrapper::~DfLsm9ds1Wrapper()
|
||||
int DfLsm9ds1Wrapper::start()
|
||||
{
|
||||
// TODO: don't publish garbage here
|
||||
accel_report accel_report = {};
|
||||
sensor_accel_s accel_report = {};
|
||||
_accel_topic = orb_advertise_multi(ORB_ID(sensor_accel), &accel_report,
|
||||
&_accel_orb_class_instance, ORB_PRIO_DEFAULT);
|
||||
|
||||
|
||||
@@ -97,7 +97,7 @@ static orb_advert_t _mag_pub = nullptr; /**< compass data publication */
|
||||
static int _mag_orb_class_instance; /**< instance handle for mag devices */
|
||||
static int _params_sub; /**< parameter update subscription */
|
||||
static struct gyro_report _gyro; /**< gyro report */
|
||||
static struct accel_report _accel; /**< accel report */
|
||||
static sensor_accel_s _accel; /**< accel report */
|
||||
static struct mag_report _mag; /**< mag report */
|
||||
static struct gyro_calibration_s _gyro_sc; /**< gyro scale */
|
||||
static struct accel_calibration_s _accel_sc; /**< accel scale */
|
||||
@@ -368,7 +368,7 @@ bool create_pubs()
|
||||
{
|
||||
// initialize the reports
|
||||
memset(&_gyro, 0, sizeof(struct gyro_report));
|
||||
memset(&_accel, 0, sizeof(struct accel_report));
|
||||
memset(&_accel, 0, sizeof(sensor_accel_s));
|
||||
memset(&_mag, 0, sizeof(struct mag_report));
|
||||
|
||||
_gyro_pub = orb_advertise_multi(ORB_ID(sensor_gyro), &_gyro,
|
||||
|
||||
@@ -90,7 +90,7 @@ accel(int argc, char *argv[], const char *path)
|
||||
fflush(stdout);
|
||||
|
||||
int fd;
|
||||
struct accel_report buf;
|
||||
struct sensor_accel_s buf;
|
||||
int ret;
|
||||
|
||||
fd = px4_open(path, O_RDONLY);
|
||||
|
||||
Reference in New Issue
Block a user