BigW Consortium Gitlab

Commit ef36600d by David Clark

Fixed gyro rate calculation

parent c3f8b300
...@@ -772,9 +772,9 @@ static int bmi088_read_raw(struct iio_dev *indio_dev, ...@@ -772,9 +772,9 @@ static int bmi088_read_raw(struct iio_dev *indio_dev,
goto exit; goto exit;
} }
data->sensor_data.x = (data->sensor_data.x / 32767) * (2000 / (range + 1)); data->sensor_data.x = (data->sensor_data.x / 32767) * (2000 / 2^range);
data->sensor_data.y = (data->sensor_data.y / 32767) * (2000 / (range + 1)); data->sensor_data.y = (data->sensor_data.y / 32767) * (2000 / 2^range);
data->sensor_data.z = (data->sensor_data.z / 32767) * (2000 / (range + 1)); data->sensor_data.z = (data->sensor_data.z / 32767) * (2000 / 2^range);
dev_dbg(&indio_dev->dev, "%s(): (x, y, z) degrees/sec: (%d, %d, %d)\n", dev_dbg(&indio_dev->dev, "%s(): (x, y, z) degrees/sec: (%d, %d, %d)\n",
__func__, data->sensor_data.x, data->sensor_data.y, data->sensor_data.z); __func__, data->sensor_data.x, data->sensor_data.y, data->sensor_data.z);
...@@ -934,9 +934,9 @@ static irqreturn_t bmi088_trigger_handler(int irq, void *p) ...@@ -934,9 +934,9 @@ static irqreturn_t bmi088_trigger_handler(int irq, void *p)
goto err; goto err;
} }
((s16 *)data->buff)[0] = (data->sensor_data.x / 32767) * (2000 / (range + 1)); ((s16 *)data->buff)[0] = (data->sensor_data.x / 32767) * (2000 / 2^range);
((s16 *)data->buff)[1] = (data->sensor_data.y / 32767) * (2000 / (range + 1)); ((s16 *)data->buff)[1] = (data->sensor_data.y / 32767) * (2000 / 2^range);
((s16 *)data->buff)[2] = (data->sensor_data.z / 32767) * (2000 / (range + 1)); ((s16 *)data->buff)[2] = (data->sensor_data.z / 32767) * (2000 / 2^range);
dev_dbg(&indio_dev->dev, "%s(): (x, y, z) degrees/sec: (%d, %d, %d)\n", dev_dbg(&indio_dev->dev, "%s(): (x, y, z) degrees/sec: (%d, %d, %d)\n",
__func__, data->sensor_data.x, data->sensor_data.y, data->sensor_data.z); __func__, data->sensor_data.x, data->sensor_data.y, data->sensor_data.z);
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment