mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-06 01:41:35 +08:00
Merge pull request #245 from julianoes/hotfix_l3gd20_axes
Fixed axis in L3GD20 driver
This commit is contained in:
@@ -684,9 +684,10 @@ L3GD20::measure()
|
|||||||
* 74 from all measurements centers them around zero.
|
* 74 from all measurements centers them around zero.
|
||||||
*/
|
*/
|
||||||
report->timestamp = hrt_absolute_time();
|
report->timestamp = hrt_absolute_time();
|
||||||
/* XXX adjust for sensor alignment to board here */
|
|
||||||
report->x_raw = raw_report.x;
|
/* swap x and y and negate y */
|
||||||
report->y_raw = raw_report.y;
|
report->x_raw = raw_report.y;
|
||||||
|
report->y_raw = ((raw_report.x == -32768) ? 32767 : -raw_report.x);
|
||||||
report->z_raw = raw_report.z;
|
report->z_raw = raw_report.z;
|
||||||
|
|
||||||
report->x = ((report->x_raw * _gyro_range_scale) - _gyro_scale.x_offset) * _gyro_scale.x_scale;
|
report->x = ((report->x_raw * _gyro_range_scale) - _gyro_scale.x_offset) * _gyro_scale.x_scale;
|
||||||
|
|||||||
Reference in New Issue
Block a user