From 448e4d8728ff709eeeb26ef7943dacbe040e6923 Mon Sep 17 00:00:00 2001 From: Jason Short Date: Mon, 11 Jun 2012 23:01:25 -0700 Subject: [PATCH] Added CLI level command --- ArduPlane/setup.pde | 21 +++++++++++++++------ 1 file changed, 15 insertions(+), 6 deletions(-) diff --git a/ArduPlane/setup.pde b/ArduPlane/setup.pde index 6bd70999166..915925252b2 100644 --- a/ArduPlane/setup.pde +++ b/ArduPlane/setup.pde @@ -3,14 +3,15 @@ #if CLI_ENABLED == ENABLED // Functions called from the setup menu -static int8_t setup_radio (uint8_t argc, const Menu::arg *argv); -static int8_t setup_show (uint8_t argc, const Menu::arg *argv); -static int8_t setup_factory (uint8_t argc, const Menu::arg *argv); -static int8_t setup_flightmodes (uint8_t argc, const Menu::arg *argv); -static int8_t setup_erase (uint8_t argc, const Menu::arg *argv); +static int8_t setup_radio (uint8_t argc, const Menu::arg *argv); +static int8_t setup_show (uint8_t argc, const Menu::arg *argv); +static int8_t setup_factory (uint8_t argc, const Menu::arg *argv); +static int8_t setup_flightmodes (uint8_t argc, const Menu::arg *argv); +static int8_t setup_level (uint8_t argc, const Menu::arg *argv); +static int8_t setup_erase (uint8_t argc, const Menu::arg *argv); static int8_t setup_compass (uint8_t argc, const Menu::arg *argv); static int8_t setup_declination (uint8_t argc, const Menu::arg *argv); -static int8_t setup_batt_monitor (uint8_t argc, const Menu::arg *argv); +static int8_t setup_batt_monitor (uint8_t argc, const Menu::arg *argv); // Command/function table for the setup menu static const struct Menu::command setup_menu_commands[] PROGMEM = { @@ -19,6 +20,7 @@ static const struct Menu::command setup_menu_commands[] PROGMEM = { {"reset", setup_factory}, {"radio", setup_radio}, {"modes", setup_flightmodes}, + {"level", setup_level}, {"compass", setup_compass}, {"declination", setup_declination}, {"battery", setup_batt_monitor}, @@ -288,6 +290,13 @@ setup_erase(uint8_t argc, const Menu::arg *argv) return 0; } +static int8_t +setup_level(uint8_t argc, const Menu::arg *argv) +{ + startup_IMU_ground(true); + return 0; +} + static int8_t setup_compass(uint8_t argc, const Menu::arg *argv) {