aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

formatting

Browse Source 
git-svn-id: https://arducopter.googlecode.com/svn/trunk@2658 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
jasonshort 2011-06-24 04:41:48 +00:00
parent d2ce6ebf8d
commit bc13dac119
1 changed files with 31 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

54
ArduCopterMega/planner.pde
View File

@ -18,33 +18,41 @@ MENU(planner_menu, "planner", planner_menu_commands);
int8_t
planner_mode(uint8_t argc, const Menu::arg *argv)
{
Serial.printf_P(PSTR("Planner Mode\n\nThis mode is not intended for manual use\n\n"));
Serial.printf_P(PSTR("Planner Mode\n\Not intended for manual use\n\n"));
planner_menu.run();
return 0;
return (0);
}
static int8_t
planner_gcs(uint8_t argc, const Menu::arg *argv)
{
gcs.init(&Serial);
int loopcount = 0;
while (1) {
if (millis()-fast_loopTimer > 19) {
fast_loopTimer = millis();
gcs.update();
#if GCS_PROTOCOL == GCS_PROTOCOL_MAVLINK
gcs.data_stream_send(45,1000);
if ((loopcount % 5) == 0) // 10 hz
gcs.data_stream_send(5,45);
if ((loopcount % 16) == 0) { // 3 hz
gcs.data_stream_send(1,5);
gcs.send_message(MSG_HEARTBEAT);
}
#endif
loopcount++;
}
}
return 0;
gcs.init(&Serial);
int loopcount = 0;
while (1) {
if (millis()-fast_loopTimer > 19) {
fast_loopTimer = millis();
gcs.update();
#if GCS_PROTOCOL == GCS_PROTOCOL_MAVLINK
gcs.data_stream_send(45, 1000);
if ((loopcount % 5) == 0) // 10 hz
gcs.data_stream_send(5, 45);
if ((loopcount % 16) == 0) { // 3 hz
gcs.data_stream_send(1, 5);
gcs.send_message(MSG_HEARTBEAT);
}
#endif
loopcount++;
}
}
return 0;
}