fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-26 03:13:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Sensor sending rate fixes

Browse Source
This commit is contained in:
Lorenz Meier
2012-09-07 12:49:31 +02:00
parent 5066ce1e91
commit 1538247a72
2 changed files with 15 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/sensors/sensors.cpp
+10
View File
@@ -696,6 +696,16 @@ Sensors::gyro_poll(struct sensor_combined_s &raw)
gyro_report.y = (gyro_report.y_raw - _parameters.gyro_offset[1]) * 0.000266316109f;
gyro_report.z = (gyro_report.z_raw - _parameters.gyro_offset[2]) * 0.000266316109f;
raw.gyro_rad_s[0] = gyro_report.x;
raw.gyro_rad_s[1] = gyro_report.y;
raw.gyro_rad_s[2] = gyro_report.z;
raw.gyro_raw[0] = gyro_report.x_raw;
raw.gyro_raw[1] = gyro_report.y_raw;
raw.gyro_raw[2] = gyro_report.z_raw;
raw.gyro_counter++;
} else {
bool gyro_updated;