input.c

   1
   2 #include "input.h"
   3 #ifdef HAS_INPUT_SUPPORT
   4
   5 void input_setup(void){
   6 }
   7
   8 void input_loop(void){
   9     input_scan_inputs();
  10     for(int i=0; i<INPUT_COUNT; i++){
  11         //A #define for the debounce time would be great
  12         if(debounce_timeouts[i] == 0){
  13             if(switch_states[i]&1 ^ switch_states[i]>>1){
  14                 uart_putc('c');
  15                 uart_puthex(i);
  16                 uart_puthex(switch_states[i]&1);
  17                 uart_putc('\n');
  18                 debounce_timeouts[i] = 0xF0;
  19                 switch_states[i] = (switch_states[i]<<1)&3;
  20             }
  21             switch_states[i] &= 0xFE;
  22         }else{
  23             debounce_timeouts[i]--;
  24         }
  25     }
  26 }
  27
  28 uint8_t debounce_timeouts[INPUT_COUNT];
  29 uint8_t switch_states[INPUT_COUNT];
  30
  31 #else//HAS_INPUT_SUPPORT
  32
  33 void input_setup(){}
  34 void input_loop(){}
  35
  36 #endif//HAS_INPUT_SUPPORT