Companion9x compilation

2012-12-22 19:11:43 +00:00
parent 4cb7f6497e
commit 310a9e03e2
1 changed files with 99 additions and 0 deletions
@@ -0,0 +1,99 @@
+/*
+ * Authors (alphabetical order)
+ * - Bertrand Songis <bsongis@gmail.com>
+ * - Bryan J. Rentoul (Gruvin) <gruvin@gmail.com>
+ * - Cameron Weeks <th9xer@gmail.com>
+ * - Erez Raviv
+ * - Jean-Pierre Parisy
+ * - Karl Szmutny <shadow@privy.de>
+ * - Michael Blandford
+ * - Michal Hlavinka
+ * - Pat Mackenzie
+ * - Philip Moss
+ * - Rob Thomson
+ * - Romolo Manfredini <romolo.manfredini@gmail.com>
+ * - Thomas Husterer
+ *
+ * open9x is based on code named
+ * gruvin9x by Bryan J. Rentoul: http://code.google.com/p/gruvin9x/,
+ * er9x by Erez Raviv: http://code.google.com/p/er9x/,
+ * and the original (and ongoing) project by
+ * Thomas Husterer, th9x: http://code.google.com/p/th9x/
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+
+#include "../open9x.h"
+
+uint32_t check_soft_power()
+{
+#ifdef SIMU
+  return e_power_on;
+#endif
+
+#if defined(REVC)
+  if ( PIOC->PIO_PDSR & PIO_PC17 )  // Power on
+  {
+    return e_power_on ;
+  }
+
+  if ( PIOA->PIO_PDSR & PIO_PA8 )   // Trainer plugged in
+  {
+    return e_power_trainer ;
+  }
+#elif defined(REVB)
+  if ( PIOC->PIO_PDSR & PIO_PC17 )  // Power on
+  {
+    return e_power_on ;
+  }
+
+  if (usbPlugged())
+  {
+    return e_power_usb ;            // Detected USB
+  }
+
+  if ( PIOA->PIO_PDSR & PIO_PA8 )   // Trainer plugged in
+  {
+    return e_power_trainer ;
+  }
+#else
+  if ( PIOC->PIO_PDSR & PIO_PC25 )
+  {
+    return e_power_usb ;            // Detected USB
+  }
+
+  if ( PIOA->PIO_PDSR & PIO_PA8 )   // Trainer plugged in
+  {
+    return e_power_trainer ;
+  }
+
+  return e_power_on;
+#endif
+
+  return e_power_off;
+}
+
+// turn off soft power
+void soft_power_off()
+{
+#if !defined(REVA)
+  configure_pins( PIO_PA8, PIN_ENABLE | PIN_OUTPUT | PIN_LOW | PIN_PORTA | PIN_NO_PULLUP ) ;
+#endif
+}
+
+#if !defined(REVA)
+void pwrInit()
+{
+  // Configure RF_power (PC17)
+  configure_pins( PIO_PC17, PIN_ENABLE | PIN_INPUT | PIN_PORTC | PIN_NO_PULLUP | PIN_PULLDOWN ) ;
+  configure_pins( PIO_PA8, PIN_ENABLE | PIN_INPUT | PIN_PORTA | PIN_PULLUP ) ; // Enable bit A8 (Soft Power)
+}
+#endif