Skip to content

Commit 766db16

Browse files
committed
Fixed sign error on adis16500 2kHz mode
1 parent 3985feb commit 766db16

File tree

1 file changed

+4
-4
lines changed

1 file changed

+4
-4
lines changed

boards/varmint_h7/common/drivers/Adis165xx.cpp

Lines changed: 4 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -236,11 +236,11 @@ void Adis165xx::endDma(void) // called when DMA data is ready
236236
data[i] = (int16_t) rx[2 * i] << 8 | ((int16_t) rx[2 * i + 1] & 0x00FF);
237237
if (sum == data[10]) {
238238
p.header.status = (uint16_t) data[1];
239-
p.gyro[0] = -(double) data[2] * 0.001745329251994; // rad/s, or use 0.1 deg/s
240-
p.gyro[1] = -(double) data[3] * 0.001745329251994; // rad/s, or use 0.1 deg/s
239+
p.gyro[0] = (double) data[2] * 0.001745329251994; // rad/s, or use 0.1 deg/s
240+
p.gyro[1] = (double) data[3] * 0.001745329251994; // rad/s, or use 0.1 deg/s
241241
p.gyro[2] = (double) data[4] * 0.001745329251994; // rad/s, or use 0.1 deg/s
242-
p.accel[0] = -(double) data[5] * 0.01225; // m/s^2
243-
p.accel[1] = -(double) data[6] * 0.01225; // m/s^2
242+
p.accel[0] = (double) data[5] * 0.01225; // m/s^2
243+
p.accel[1] = (double) data[6] * 0.01225; // m/s^2
244244
p.accel[2] = (double) data[7] * 0.01225; // m/s^2
245245
p.temperature = (double) data[8] * 0.1 + 273.15; // K
246246
p.dataTime = (double) ((uint16_t) data[9]) / sampleRateHz_;

0 commit comments

Comments
 (0)