|
|
|
@ -640,7 +640,7 @@ MPU6000::init()
@@ -640,7 +640,7 @@ MPU6000::init()
|
|
|
|
|
return ret; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
_gyro_reports = new ringbuffer::RingBuffer(2, sizeof(gyro_report)); |
|
|
|
|
_gyro_reports = new ringbuffer::RingBuffer(2, sizeof(sensor_gyro_s)); |
|
|
|
|
|
|
|
|
|
if (_gyro_reports == nullptr) { |
|
|
|
|
return ret; |
|
|
|
@ -718,7 +718,7 @@ MPU6000::init()
@@ -718,7 +718,7 @@ MPU6000::init()
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* advertise sensor topic, measure manually to initialize valid report */ |
|
|
|
|
struct gyro_report grp; |
|
|
|
|
sensor_gyro_s grp; |
|
|
|
|
_gyro_reports->get(&grp); |
|
|
|
|
|
|
|
|
|
_gyro->_gyro_topic = orb_advertise_multi(ORB_ID(sensor_gyro), &grp, |
|
|
|
@ -1220,7 +1220,7 @@ MPU6000::test_error()
@@ -1220,7 +1220,7 @@ MPU6000::test_error()
|
|
|
|
|
ssize_t |
|
|
|
|
MPU6000::gyro_read(struct file *filp, char *buffer, size_t buflen) |
|
|
|
|
{ |
|
|
|
|
unsigned count = buflen / sizeof(gyro_report); |
|
|
|
|
unsigned count = buflen / sizeof(sensor_gyro_s); |
|
|
|
|
|
|
|
|
|
/* buffer must be large enough */ |
|
|
|
|
if (count < 1) { |
|
|
|
@ -1239,7 +1239,7 @@ MPU6000::gyro_read(struct file *filp, char *buffer, size_t buflen)
@@ -1239,7 +1239,7 @@ MPU6000::gyro_read(struct file *filp, char *buffer, size_t buflen)
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* copy reports out of our buffer to the caller */ |
|
|
|
|
gyro_report *grp = reinterpret_cast<gyro_report *>(buffer); |
|
|
|
|
sensor_gyro_s *grp = reinterpret_cast<sensor_gyro_s *>(buffer); |
|
|
|
|
int transferred = 0; |
|
|
|
|
|
|
|
|
|
while (count--) { |
|
|
|
@ -1252,7 +1252,7 @@ MPU6000::gyro_read(struct file *filp, char *buffer, size_t buflen)
@@ -1252,7 +1252,7 @@ MPU6000::gyro_read(struct file *filp, char *buffer, size_t buflen)
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* return the number of bytes transferred */ |
|
|
|
|
return (transferred * sizeof(gyro_report)); |
|
|
|
|
return (transferred * sizeof(sensor_gyro_s)); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
int |
|
|
|
@ -1796,7 +1796,7 @@ MPU6000::measure()
@@ -1796,7 +1796,7 @@ MPU6000::measure()
|
|
|
|
|
* Report buffers. |
|
|
|
|
*/ |
|
|
|
|
sensor_accel_s arb; |
|
|
|
|
gyro_report grb; |
|
|
|
|
sensor_gyro_s grb; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Adjust and scale results to m/s^2. |
|
|
|
@ -2248,7 +2248,7 @@ test(enum MPU6000_BUS busid)
@@ -2248,7 +2248,7 @@ test(enum MPU6000_BUS busid)
|
|
|
|
|
{ |
|
|
|
|
struct mpu6000_bus_option &bus = find_bus(busid); |
|
|
|
|
sensor_accel_s a_report{}; |
|
|
|
|
gyro_report g_report; |
|
|
|
|
sensor_gyro_s g_report{}; |
|
|
|
|
ssize_t sz; |
|
|
|
|
|
|
|
|
|
/* get the driver */ |
|
|
|
|