Mike's bootloader sources + added as option, for Taranis only for now (not as clean as it could be, bootloader is always built even if not selected - didn't find how to nest ifs in makefile :\ ) (Issue #546)

2014-01-18 20:00:31 +01:00
parent 34776b24c0
commit 229dfc1938
159 changed files with 66903 additions and 2000 deletions
@@ -0,0 +1,206 @@
+/*
+ * Author - Mike Blandford
+ *
+ * Based on er9x by Erez Raviv <erezraviv@gmail.com>
+ *
+ * Based on 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 <stdint.h>
+#include <stdlib.h>
+
+#ifdef PCBSKY
+#include "radio.h"
+#include "drivers.h"
+#endif
+
+
+#ifdef PCBX9D
+#include "radio.h"
+#include "hal.h"
+#include "stm32f2xx.h"
+#include "stm32f2xx_gpio.h"
+#include "stm32f2xx_rcc.h"
+#endif
+#include "drivers.h"
+#include "logicio.h"
+
+#ifdef EVT_KEY_MASK
+#undef EVT_KEY_MASK
+#endif
+
+#define EVT_KEY_MASK             0x0f
+
+
+void b_putEvent( register uint8_t evt) ;
+void per10ms( void ) ;
+uint8_t getEvent( void ) ;
+void pauseEvents(uint8_t event) ;
+void killEvents(uint8_t event) ;
+
+uint8_t s_evt;
+void b_putEvent( uint8_t evt)
+{
+  s_evt = evt;
+}
+
+
+uint8_t getEvent()
+{
+  register uint8_t evt = s_evt;
+  s_evt=0;
+  return evt;
+}
+
+Key keys[NUM_KEYS] ;
+
+void Key::input(bool val, EnumKeys enuk)
+{
+  //  uint8_t old=m_vals;
+  m_vals <<= 1;  if(val) m_vals |= 1; //portbit einschieben
+  m_cnt++;
+
+  if(m_state && m_vals==0){  //gerade eben sprung auf 0
+    if(m_state!=KSTATE_KILLED) {
+      b_putEvent(EVT_KEY_BREAK(enuk));
+    }
+    m_cnt   = 0;
+    m_state = KSTATE_OFF;
+  }
+  switch(m_state){
+    case KSTATE_OFF:
+      if(m_vals==FFVAL){ //gerade eben sprung auf ff
+        m_state = KSTATE_START;
+        m_cnt   = 0;
+      }
+      break;
+      //fallthrough
+    case KSTATE_START:
+      b_putEvent(EVT_KEY_FIRST(enuk));
+#ifdef KSTATE_RPTDELAY
+      m_state   = KSTATE_RPTDELAY;
+#else
+      m_state   = 16;
+#endif
+      m_cnt     = 0;
+      break;
+#ifdef KSTATE_RPTDELAY
+    case KSTATE_RPTDELAY: // gruvin: longer delay before first key repeat
+      if(m_cnt == 32) b_putEvent(EVT_KEY_LONG(enuk)); // need to catch this inside RPTDELAY time
+      if (m_cnt == 40) {
+        m_state = 16;
+        m_cnt = 0;
+      }
+      break;
+#endif
+    case 16:
+#ifndef KSTATE_RPTDELAY
+      if(m_cnt == 32) b_putEvent(EVT_KEY_LONG(enuk));
+      //fallthrough
+#endif
+    case 8:
+    case 4:
+    case 2:
+      if(m_cnt >= 48)  { //3 6 12 24 48 pulses in every 480ms
+        m_state >>= 1;
+        m_cnt     = 0;
+      }
+      //fallthrough
+    case 1:
+      if( (m_cnt & (m_state-1)) == 0)  b_putEvent(EVT_KEY_REPT(enuk));
+      break;
+
+    case KSTATE_PAUSE: //pause
+      if(m_cnt >= 64)      {
+        m_state = 8;
+        m_cnt   = 0;
+      }
+      break;
+
+    case KSTATE_KILLED: //killed
+      break;
+  }
+}
+
+void b_pauseEvents(uint8_t event)
+{
+  event=event & EVT_KEY_MASK;
+  if(event < (int)DIM(keys))  keys[event].pauseEvents();
+}
+
+void killEvents(uint8_t event)
+{
+  event=event & EVT_KEY_MASK;
+  if(event < (int)DIM(keys))  keys[event].killEvents();
+}
+
+void per10ms()
+{
+	register uint32_t i ;
+
+  uint8_t enuk = KEY_MENU;
+  uint8_t    in = ~read_keys() ;
+	// Bits 3-6 are down, up, right and left
+	// Try to only allow one at a 
+#ifdef REVX
+	static uint8_t current ;
+	uint8_t dir_keys ;
+	uint8_t lcurrent ;
+
+	dir_keys = in & 0x78 ;		// Mask to direction keys
+	if ( ( lcurrent = current ) )
+	{ // Something already pressed
+		if ( ( lcurrent & dir_keys ) == 0 )
+		{
+			lcurrent = 0 ;	// No longer pressed
+		}
+		else
+		{
+			in &= lcurrent | 0x06 ;	// current or MENU or EXIT allowed
+		}
+	}
+	if ( lcurrent == 0 )
+	{ // look for a key
+		if ( dir_keys & 0x20 )	// right
+		{
+			lcurrent = 0x60 ;		// Allow L and R for 9X
+		}
+		else if ( dir_keys & 0x40 )	// left
+		{
+			lcurrent = 0x60 ;		// Allow L and R for 9X
+		}
+		else if ( dir_keys & 0x08 )	// down
+		{
+			lcurrent = 0x08 ;
+		}
+		else if ( dir_keys & 0x10 )	// up
+		{
+			lcurrent = 0x10 ;
+		}
+		in &= lcurrent | 0x06 ;	// current or MENU or EXIT allowed
+	}
+	current = lcurrent ;
+#endif
+
+  for( i=1; i<7; i++)
+  {
+		uint8_t value = in & (1<<i) ;
+    //INP_B_KEY_MEN 1  .. INP_B_KEY_LFT 6
+    keys[enuk].input(value,(EnumKeys)enuk);
+    ++enuk;
+  }
+}
+
+