X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_telemetrum.c;h=bede5868aa75083e4c81fed18fa247776e746e76;hb=a08173197d5533ecb395102ed34e751135660d06;hp=a680ce19675180b0377887b33e0609d82169f5d8;hpb=210dbaa23cdacf3a6f2d6e23493e96ee2ac9bca7;p=fw%2Faltos

diff --git a/src/ao_telemetrum.c b/src/ao_telemetrum.c
index a680ce19..bede5868 100644
--- a/src/ao_telemetrum.c
+++ b/src/ao_telemetrum.c
@@ -16,23 +16,40 @@
  */
 
 #include "ao.h"
+#include "ao_pins.h"
+
+/* stub so as telemetrum doesn't have monitor mode */
+void
+ao_set_monitor(uint8_t monitoring)
+{
+	(void) monitoring;
+}
 
 void
 main(void)
 {
-	CLKCON = 0;
-	while (!(SLEEP & SLEEP_XOSC_STB))
-		;
+	ao_clock_init();
+
 
 	/* Turn on the red LED until the system is stable */
-	ao_led_init(AO_LED_RED|AO_LED_GREEN);
+	ao_led_init(LEDS_AVAILABLE);
 	ao_led_on(AO_LED_RED);
 
+	/* A hack -- look at the SPI clock pin, if it's sitting at
+	 *  ground, then we force the computer to idle mode instead of
+	 *  flight mode
+	 */
+	if (P1_3 == 0) {
+		ao_flight_force_idle = 1;
+		while (P1_3 == 0)
+			;
+	}
 	ao_timer_init();
 	ao_adc_init();
 	ao_beep_init();
 	ao_cmd_init();
-	ao_ee_init();
+	ao_spi_init();
+	ao_storage_init();
 	ao_flight_init();
 	ao_log_init();
 	ao_report_init();
@@ -40,10 +57,13 @@ main(void)
 	ao_serial_init();
 	ao_gps_init();
 	ao_gps_report_init();
-	ao_telemetry_init();
+	ao_telemetry_orig_init();
 	ao_radio_init();
+	ao_packet_slave_init(TRUE);
 	ao_igniter_init();
+#if HAS_DBG
 	ao_dbg_init();
+#endif
 	ao_config_init();
 	ao_start_scheduler();
 }