]> git.cryptolib.org Git - labortage2013badge.git/blobdiff - firmware/main.c
this should work
[labortage2013badge.git] / firmware / main.c
index cdbc69dba5384106ce5d51f87c62db7ea23da595..53898b05ea0f5ccef6e9bfe7a1a71c36973b0533 100644 (file)
@@ -38,8 +38,8 @@ different port or bit, change the macros below:
 #include "oddebug.h"        /* This is also an example for using debug macros */
 #include "requests.h"       /* The custom request numbers we use */
 #include "special_functions.h"
-
-void update_pwm(void);
+#include "hotp.h"
+#include "percnt2.h"
 
 /* ------------------------------------------------------------------------- */
 /* ----------------------------- USB interface ----------------------------- */
@@ -79,6 +79,11 @@ PROGMEM const char usbHidReportDescriptor[USB_CFG_HID_REPORT_DESCRIPTOR_LENGTH]
     0xc0                           // END_COLLECTION
 };
 
+uint16_t secret_length_ee EEMEM = 0;
+uint8_t  secret_ee[32] EEMEM;
+uint8_t  reset_counter_ee EEMEM = 0;
+uint8_t  digits_ee EEMEM = 8;
+
 /* Keyboard usage values, see usb.org's HID-usage-tables document, chapter
  * 10 Keyboard/Keypad Page for more codes.
  */
@@ -145,16 +150,14 @@ PROGMEM const char usbHidReportDescriptor[USB_CFG_HID_REPORT_DESCRIPTOR_LENGTH]
 #define CAPS_LOCK 2
 #define SCROLL_LOCK 4
 
-union {
-       struct {
-               uint16_t red;
-               uint16_t green;
-               uint16_t blue;
-       } name;
-       uint16_t idx[3];
-} color;
+static uint8_t dbg_buffer[8];
+
+static uint8_t secret[32];
+static uint16_t secret_length_b;
+static char token[10];
 
-#define UNI_BUFFER_SIZE 16
+
+#define UNI_BUFFER_SIZE 36
 
 static union {
        uint8_t  w8[UNI_BUFFER_SIZE];
@@ -175,6 +178,7 @@ typedef struct {
 #define STATE_WAIT 0
 #define STATE_SEND_KEY 1
 #define STATE_RELEASE_KEY 2
+#define STATE_NEXT 3
 
 
 static keyboard_report_t keyboard_report; // sent to PC
@@ -183,28 +187,100 @@ static uchar key_state = STATE_WAIT;
 volatile static uchar LED_state = 0xff; // received from PC
 /* ------------------------------------------------------------------------- */
 
+void memory_clean(void) {
+    memset(secret, 0, 32);
+    secret_length_b = 0;
+}
+
+uint8_t secret_set(void){
+    uint8_t r;
+    union {
+        uint8_t w8[32];
+        uint16_t w16[16];
+    } read_back;
+    const uint8_t length_B = (secret_length_b + 7) / 8;
+
+    eeprom_busy_wait();
+    eeprom_write_block(secret, secret_ee, length_B);
+    eeprom_busy_wait();
+    eeprom_read_block(read_back.w8, secret_ee, length_B);
+    r = memcmp(secret, read_back.w8, length_B);
+    memory_clean();
+    memset(read_back.w8, 0, 32);
+    if (r) {
+        return 1;
+    }
+    eeprom_busy_wait();
+    eeprom_write_word(&secret_length_ee, secret_length_b);
+    eeprom_busy_wait();
+    r = eeprom_read_word(&secret_length_ee) == secret_length_b;
+    memory_clean();
+    *read_back.w16 = 0;
+    if (!r) {
+        return 1;
+    }
+    return 0;
+}
+
+void token_generate(void) {
+    percnt_inc(0);
+    eeprom_busy_wait();
+    eeprom_read_block(secret, secret_ee, 32);
+    eeprom_busy_wait();
+    hotp(token, secret, eeprom_read_word(&secret_length_ee), percnt_get(0), eeprom_read_byte(&digits_ee));
+    memory_clean();
+}
+
+void counter_reset(void) {
+    uint8_t reset_counter;
+    eeprom_busy_wait();
+    reset_counter = eeprom_read_byte(&reset_counter_ee);
+    percnt_reset(0);
+    eeprom_busy_wait();
+    eeprom_write_byte(&reset_counter_ee, reset_counter + 1);
+}
+
+void counter_init(void) {
+    eeprom_busy_wait();
+    if (eeprom_read_byte(&reset_counter_ee) == 0) {
+        counter_reset();
+    }
+    percnt_init(0);
+}
+
 void buildReport(uchar send_key) {
     keyboard_report.modifier = 0;
 
-    if(send_key >= 'a' && send_key <= 'z')
-        keyboard_report.keycode[0] = 4 + (send_key - 'a');
-    else
+    switch (send_key) {
+    case 'A' ... 'Z':
+        keyboard_report.modifier = MOD_SHIFT_LEFT;
+        keyboard_report.keycode[0] = KEY_A + (send_key-'A');
+        break;
+    case 'a' ... 'z':
+        keyboard_report.keycode[0] = KEY_A + (send_key-'a');
+        break;
+    case '1' ... '9':
+        keyboard_report.keycode[0] = KEY_1 + (send_key-'1');
+        break;
+    case '0':
+        keyboard_report.keycode[0] = KEY_0;
+        break;
+    default:
         keyboard_report.keycode[0] = 0;
+    }
 }
 
-uint8_t read_button(void){
-       uint8_t t,v=0;
-       t = DDRB;
-       DDRB &= ~(1<<BUTTON_PIN);
-       PORTB |= 1<<BUTTON_PIN;
-       PORTB &= ~(1<<BUTTON_PIN);
-       v |= PINB;
-       DDRB |= t&(1<<BUTTON_PIN);
-       PORTB &= ~(t&(1<<BUTTON_PIN));
-       v >>= BUTTON_PIN;
-       v &= 1;
-       v ^= 1;
-       return v;
+static inline
+int8_t button_get_debounced(uint8_t debounce_count) {
+    uint8_t v;
+    v = PINB & _BV(BUTTON_PIN);
+    while (debounce_count-- && v == (PINB & _BV(BUTTON_PIN))) {
+        ;
+    }
+    if (debounce_count) {
+        return -1;
+    }
+    return v ? 0 : 1;
 }
 
 void init_temperature_sensor(void){
@@ -219,35 +295,10 @@ uint16_t read_temperture_sensor(void){
        return ADC;
 }
 
-#if 0
-uchar   usbFunctionSetup(uchar data[8])
-{
-usbRequest_t    *rq = (void *)data;
-
-    usbMsgPtr = reportBuffer;
-    if((rq->bmRequestType & USBRQ_TYPE_MASK) == USBRQ_TYPE_CLASS){    /* class request type */
-        if(rq->bRequest == USBRQ_HID_GET_REPORT){  /* wValue: ReportType (highbyte), ReportID (lowbyte) */
-            /* we only have one report type, so don't look at wValue */
-            buildReport(keyPressed());
-            return sizeof(reportBuffer);
-        }else if(rq->bRequest == USBRQ_HID_GET_IDLE){
-            usbMsgPtr = &idleRate;
-            return 1;
-        }else if(rq->bRequest == USBRQ_HID_SET_IDLE){
-            idleRate = rq->wValue.bytes[1];
-        }
-    }else{
-        /* no vendor specific requests implemented */
-    }
-    return 0;
-}
-#endif
-
 usbMsgLen_t usbFunctionSetup(uchar data[8])
 {
        usbRequest_t    *rq = (usbRequest_t *)data;
        if ((rq->bmRequestType & USBRQ_TYPE_MASK) == USBRQ_TYPE_CLASS) {    /* class request type */
-           color.name.red = 13;
            switch(rq->bRequest) {
         case USBRQ_HID_GET_REPORT: // send "no keys pressed" if asked here
             // wValue: ReportType (highbyte), ReportID (lowbyte)
@@ -273,14 +324,59 @@ usbMsgLen_t usbFunctionSetup(uchar data[8])
                current_command = rq->bRequest;
        switch(rq->bRequest)
                {
-               case CUSTOM_RQ_SET_RGB:
+       case CUSTOM_RQ_SET_SECRET:
+           secret_length_b = rq->wValue.word;
+           if (secret_length_b > 256) {
+               secret_length_b = 256;
+           }
+           uni_buffer.w8[0] = 0;
+           return USB_NO_MSG;
+       case CUSTOM_RQ_INC_COUNTER:
+           percnt_inc(0);
+           return 0;
+       case CUSTOM_RQ_GET_COUNTER:
+           uni_buffer.w32[0] = percnt_get(0);
+           usbMsgPtr = (usbMsgPtr_t)uni_buffer.w32;
+           return 4;
+       case CUSTOM_RQ_RESET_COUNTER:
+           counter_reset();
+           return 0;
+        case CUSTOM_RQ_GET_RESET_COUNTER:
+           eeprom_busy_wait();
+            uni_buffer.w8[0] = eeprom_read_byte(&reset_counter_ee);
+            usbMsgPtr = uni_buffer.w8;
+            return 1;
+       case CUSTOM_RQ_SET_DIGITS:
+           if (rq->wValue.bytes[0] > 9) {
+               rq->wValue.bytes[0] = 9;
+           }
+           eeprom_busy_wait();
+           eeprom_write_byte(&digits_ee, rq->wValue.bytes[0]);
+           return 0;
+       case CUSTOM_RQ_GET_DIGITS:
+           eeprom_busy_wait();
+            uni_buffer.w8[0] = eeprom_read_byte(&digits_ee);
+            usbMsgPtr = uni_buffer.w8;
+            return 1;
+       case CUSTOM_RQ_GET_TOKEN:
+           token_generate();
+           usbMsgPtr = (usbMsgPtr_t)token;
+           return strlen(token);
+
+       case CUSTOM_RQ_PRESS_BUTTON:
+           key_state = STATE_SEND_KEY;
+           return 0;
+       case CUSTOM_RQ_CLR_DBG:
+            memset(dbg_buffer, 0, sizeof(dbg_buffer));
+            return 0;
+               case CUSTOM_RQ_SET_DBG:
                        return USB_NO_MSG;
-               case CUSTOM_RQ_GET_RGB:{
-                       usbMsgLen_t len = 6;
-                       if(len>rq->wLength.word){
+               case CUSTOM_RQ_GET_DBG:{
+                       usbMsgLen_t len = 8;
+                       if(len > rq->wLength.word){
                                len = rq->wLength.word;
                        }
-                       usbMsgPtr = (uchar*)color.idx;
+                       usbMsgPtr = dbg_buffer;
                        return len;
                }
                case CUSTOM_RQ_READ_MEM:
@@ -288,19 +384,20 @@ usbMsgLen_t usbFunctionSetup(uchar data[8])
                        return rq->wLength.word;
                case CUSTOM_RQ_WRITE_MEM:
                case CUSTOM_RQ_EXEC_SPM:
-                       uni_buffer_fill = 4;
+/*                     uni_buffer_fill = 4;
                        uni_buffer.w16[0] = rq->wValue.word;
                        uni_buffer.w16[1] = rq->wLength.word;
                        return USB_NO_MSG;
-               case CUSTOM_RQ_READ_FLASH:
+*/             case CUSTOM_RQ_READ_FLASH:
                        uni_buffer.w16[0] = rq->wValue.word;
                        uni_buffer.w16[1] = rq->wLength.word;
+            uni_buffer_fill = 4;
                        return USB_NO_MSG;
                case CUSTOM_RQ_RESET:
                        soft_reset((uint8_t)(rq->wValue.word));
                        break;
                case CUSTOM_RQ_READ_BUTTON:
-                       uni_buffer.w8[0] = read_button();
+                       uni_buffer.w8[0] = button_get_debounced(25);
                        usbMsgPtr = uni_buffer.w8;
                        return 1;
                case CUSTOM_RQ_READ_TMPSENS:
@@ -322,12 +419,23 @@ uchar usbFunctionWrite(uchar *data, uchar len)
            if (data[0] != LED_state)
                LED_state = data[0];
            return 1; // Data read, not expecting more
-       case CUSTOM_RQ_SET_RGB:
-               if(len != 6){
-                       return 1;
+       case CUSTOM_RQ_SET_SECRET:
+        {
+            if (uni_buffer.w8[0] < (secret_length_b + 7) / 8) {
+                memcpy(&secret[uni_buffer.w8[0]], data, len);
+                uni_buffer.w8[0] += len;
+            }
+            if (uni_buffer.w8[0] >= (secret_length_b + 7) / 8) {
+                secret_set();
+                return 1;
+            }
+            return 0;
+        }
+       case CUSTOM_RQ_SET_DBG:
+               if(len > sizeof(dbg_buffer)){
+                       len = sizeof(dbg_buffer);
                }
-               memcpy(color.idx, data, 6);
-        key_state = STATE_SEND_KEY;
+               memcpy(dbg_buffer, data, len);
                return 1;
        case CUSTOM_RQ_WRITE_MEM:
                memcpy(uni_buffer.ptr[0], data, len);
@@ -416,7 +524,8 @@ void usbEventResetReady(void)
 
 int main(void)
 {
-       uchar   i;
+       size_t idx = 0;
+       int8_t i = 0, last_stable_button_state = 0;
 
     wdt_enable(WDTO_1S);
     /* Even if you don't use the watchdog, turn it off here. On newer devices,
@@ -427,50 +536,52 @@ int main(void)
      * additional hardware initialization.
      */
 
-    memset(&keyboard_report, 0, sizeof(keyboard_report));
-
+    DDRB &= ~_BV(BUTTON_PIN); /* make button pin input */
+    PORTB |= _BV(BUTTON_PIN); /* turn on pull-up resistor */
     init_temperature_sensor();
     usbInit();
     usbDeviceDisconnect();  /* enforce re-enumeration, do this while interrupts are disabled! */
-    i = 0;
     while(--i){             /* fake USB disconnect for ~512 ms */
         wdt_reset();
         _delay_ms(2);
     }
     usbDeviceConnect();
-    LED_PORT_DDR |= _BV(R_BIT) | _BV(G_BIT) | _BV(B_BIT);   /* make the LED bit an output */
-
        
     sei();
 
     for(;;){                /* main event loop */
-       //      update_pwm();
-               
         wdt_reset();
         usbPoll();
 
-        if(usbInterruptIsReady())
-            color.name.green = 0x10 | key_state;
-        else
-            color.name.green = 0;
+        i = button_get_debounced(25);
+        if (i != -1) {
+            if (last_stable_button_state == 0 && i == 1) {
+                key_state = STATE_SEND_KEY;
+            }
+            last_stable_button_state = i;
+        }
 
         if(usbInterruptIsReady() && key_state != STATE_WAIT){
-            color.name.red = 16;
             switch(key_state) {
             case STATE_SEND_KEY:
-                color.name.red = 17;
-                buildReport('x');
+                buildReport(token[idx]);
                 key_state = STATE_RELEASE_KEY; // release next
                 break;
             case STATE_RELEASE_KEY:
-                color.name.red = 18;
                 buildReport(0);
+                ++idx;
+                if (token[idx] == '\0') {
+                    idx = 0;
+                    key_state = STATE_WAIT;
+                } else {
+                    key_state = STATE_SEND_KEY;
+                }
+                break;
             default:
                 key_state = STATE_WAIT; // should not happen
             }
                         // start sending
             usbSetInterrupt((void *)&keyboard_report, sizeof(keyboard_report));
-            color.name.red |= 0x40;
 
         }