rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-18 03:52:11 +01:00
Code Issues Releases Activity

Make fake telemetry show rotating attitude.

Browse Source
This commit is contained in:
James Cotton 2011-03-22 12:59:17 -05:00
parent 5669a3fc33
commit 56aca6a8ec
1 changed files with 11 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
androidgcs/src/org/openpilot/androidgcs/OPTelemetryService.java
View File

@ -200,8 +200,19 @@ public class OPTelemetryService extends Service {
//toastMessage("Started fake telemetry thread");
UAVDataObject systemStats = (UAVDataObject) objMngr.getObject("SystemStats");
UAVDataObject attitudeActual = (UAVDataObject) objMngr.getObject("AttitudeActual");
double roll = 0;
double pitch = 0;
double yaw = 0;
while( !terminate ) {
attitudeActual.getField("Roll").setDouble(roll);
attitudeActual.getField("Pitch").setDouble(pitch);
attitudeActual.getField("Yaw").setDouble(yaw);
roll = (roll + 10) % 180;
pitch = (pitch + 10) % 180;
yaw = (yaw + 10) % 360;
systemStats.updated();
attitudeActual.updated();
try {
Thread.sleep(1000);
} catch (InterruptedException e) {