1 files changed, 153 insertions, 0 deletions
diff --git a/dolmetsch-ctl/keypad.c b/dolmetsch-ctl/keypad.c
new file mode 100644
index 0000000..a4bcabc
--- /dev/null
+++ b/dolmetsch-ctl/keypad.c
@@ -0,0 +1,153 @@
+/*
+ *  spreadspace avr utils
+ *
+ *
+ *  Copyright (C) 2013-2014 Christian Pointner <equinox@spreadspace.org>
+ *
+ *  This file is part of spreadspace avr utils.
+ *
+ *  spreadspace avr utils is free software: you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation, either version 3 of the License, or
+ *  any later version.
+ *
+ *  spreadspace avr utils 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.
+ *
+ *  You should have received a copy of the GNU General Public License
+ *  along with spreadspace avr utils. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <avr/io.h>
+#include <util/delay.h>
+
+#include "keypad.h"
+#include "eventqueue.h"
+
+#define KEYPAD_LP_CNT_MAX 200
+static struct {
+  uint8_t last_sent;
+  int16_t lp_cnt;
+} keypad_state[KEYPAD_NUM_KEYS];
+
+static struct {
+  uint16_t delay;
+  uint16_t cnt;
+} led_blink_state[KEYPAD_NUM_KEYS];
+
+void keypad_init(void)
+{
+      // KEYS are at F4..F7
+  DDRF &= 0x0F;
+  PORTF |= 0xF0;
+  uint8_t i;
+  for(i = 0; i < KEYPAD_NUM_KEYS; ++i) {
+    keypad_state[i].last_sent = 0;
+    keypad_state[i].lp_cnt = 0;
+
+    led_blink_state[i].delay = 0;
+    led_blink_state[i].cnt = 0;
+  }
+
+      // LEDS are at D0..D3
+  DDRD |= 0x0F;
+  PORTD &= 0xFC;
+  PORTD |= 0x0C;
+}
+
+void keypad_led_on(uint8_t led)
+{
+  switch(led) {
+    case 0: PORTD |= 0x01; break;
+    case 1: PORTD |= 0x02; break;
+    case 2: PORTD &= 0xFB; break;
+    case 3: PORTD &= 0xF7; break;
+    case KEYPAD_MIDI_NOTE_ALL - KEYPAD_MIDI_NOTE_OFFSET: PORTD |= 0x03; PORTD &= 0xF3;; break;
+  }
+  keypad_led_blink(led, 0);
+}
+
+void keypad_led_off(uint8_t led)
+{
+  switch(led) {
+    case 0: PORTD &= 0xFE; break;
+    case 1: PORTD &= 0xFD; break;
+    case 2: PORTD |= 0x04; break;
+    case 3: PORTD |= 0x08; break;
+    case KEYPAD_MIDI_NOTE_ALL - KEYPAD_MIDI_NOTE_OFFSET: PORTD &= 0xFC; PORTD |= 0x0C; break;
+  }
+  keypad_led_blink(led, 0);
+}
+
+void keypad_led_toggle(uint8_t led)
+{
+  switch(led) {
+    case 0:
+    case 1:
+    case 2:
+    case 3: PORTD ^= (1 << led); break;
+    case KEYPAD_MIDI_NOTE_ALL - KEYPAD_MIDI_NOTE_OFFSET: PORTD ^= 0x0F; break;
+  }
+}
+
+void keypad_led_blink(uint8_t led, uint8_t value)
+{
+  if(led < KEYPAD_NUM_KEYS) {
+    led_blink_state[led].delay = value * 128;
+    led_blink_state[led].cnt = 0;
+  } else {
+    uint8_t i;
+    for(i = 0; i < KEYPAD_NUM_KEYS; ++i) {
+      led_blink_state[i].delay = value * 128;
+      led_blink_state[i].cnt = 0;
+    }
+  }
+}
+
+static inline void keypad_key_lowpass(uint8_t key_idx, uint8_t current_state)
+{
+  keypad_state[key_idx].lp_cnt += current_state ? -1 : +1;
+  if(keypad_state[key_idx].lp_cnt <= 0 ||
+     keypad_state[key_idx].lp_cnt >= KEYPAD_LP_CNT_MAX) {
+
+    keypad_state[key_idx].lp_cnt = keypad_state[key_idx].lp_cnt <= 0 ? 0 : KEYPAD_LP_CNT_MAX;
+
+    if(current_state != keypad_state[key_idx].last_sent) {
+      keypad_state[key_idx].last_sent = current_state;
+      eventqueue_push(KEYPAD_MIDI_NOTE_OFFSET + key_idx, ((current_state) ? 0 : 1));
+    }
+  }
+}
+
+static inline void keypad_led_blinking(uint8_t key_idx)
+{
+  if(led_blink_state[key_idx].delay > 1) {
+    if(++led_blink_state[key_idx].cnt >= led_blink_state[key_idx].delay) {
+      keypad_led_toggle(key_idx);
+      led_blink_state[key_idx].cnt = 0;
+    }
+  }
+}
+
+void keypad_task(void)
+{
+  uint8_t col, row;
+  for(col = 0; col < KEYPAD_NUM_COLS; ++col) {
+    /* KEYPAD_DDR = 1 << (col + 4); */
+    /* KEYPAD_PORT = 0x0F; */
+    _delay_us(20);
+
+    for(row = 0; row < KEYPAD_NUM_ROWS; ++row) {
+      uint8_t key_idx = col*KEYPAD_NUM_ROWS + row;
+
+//      uint8_t current_state = KEYPAD_PIN & (1 << row);
+      uint8_t current_state = PINF & (1 << (row+4));
+      keypad_key_lowpass(key_idx, current_state);
+
+      keypad_led_blinking(key_idx);
+    }
+  }
+//  KEYPAD_DDR = 0x00;
+}