TEAMUSB / Mbed 2 deprecated TEAMUSB_SLAVE

TEAMUSB_SLAVE

Dependencies:   USBHost mbed

Fork of USBHostKeyboard_HelloWorld by TEAMUSB

main.cpp@12:d32975c44c98, 2015-04-16 (annotated)

Committer:
gabriel4211
Date:
Thu Apr 16 13:44:57 2015 +0000
Revision:
12:d32975c44c98
Parent:
11:e12aae7de530
Child:
13:b05908f05e81
working (and messy) state;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samux 0:88d52e197201 1 #include "mbed.h"
samux 0:88d52e197201 2 #include "USBHostKeyboard.h"
wlangenkamp 7:be82ac3c4821 3 #include "rtos.h"
gabriel4211 12:d32975c44c98 4 //#include <queue>
gabriel4211 12:d32975c44c98 5
gabriel4211 12:d32975c44c98 6 typedef struct {
gabriel4211 12:d32975c44c98 7 uint8_t key;
gabriel4211 12:d32975c44c98 8 uint8_t modifier;
gabriel4211 12:d32975c44c98 9 } keyPress_t;
gabriel4211 12:d32975c44c98 10
gabriel4211 12:d32975c44c98 11
gabriel4211 12:d32975c44c98 12 static uint8_t keymap[57] = {
gabriel4211 12:d32975c44c98 13 0, 0, 0, 0, 'a', 'b' /*0x05*/,
gabriel4211 12:d32975c44c98 14 'c', 'd', 'e', 'f', 'g' /*0x0a*/,
gabriel4211 12:d32975c44c98 15 'h', 'i', 'j', 'k', 'l'/*0x0f*/,
gabriel4211 12:d32975c44c98 16 'm', 'n', 'o', 'p', 'q'/*0x14*/,
gabriel4211 12:d32975c44c98 17 'r', 's', 't', 'u', 'v'/*0x19*/,
gabriel4211 12:d32975c44c98 18 'w', 'x', 'y', 'z', '1'/*0x1E*/,
gabriel4211 12:d32975c44c98 19 '2', '3', '4', '5', '6'/*0x23*/,
gabriel4211 12:d32975c44c98 20 '7', '8', '9', '0', 0x0A /*enter*/, /*0x28*/
gabriel4211 12:d32975c44c98 21 0x1B /*escape*/, 0x08 /*backspace*/, 0x09/*tab*/, 0x20/*space*/, '-', /*0x2d*/
gabriel4211 12:d32975c44c98 22 '=', '[', ']', '\\', '#', /*0x32*/
gabriel4211 12:d32975c44c98 23 ';', '\'', 0, ',', '.', /*0x37*/
gabriel4211 12:d32975c44c98 24 '/'};
samux 0:88d52e197201 25
samux 0:88d52e197201 26 DigitalOut led(LED1);
armdran 9:8bcd70b26084 27 SPISlave device(D11, D12, D13, D10);
armdran 11:e12aae7de530 28 DigitalOut ir(D9);
gabriel4211 12:d32975c44c98 29 //std::queue<uint8_t> _keyQueue;
gabriel4211 12:d32975c44c98 30 Queue<keyPress_t, 16> _keyQueue;
gabriel4211 12:d32975c44c98 31 MemoryPool<keyPress_t, 16> mpool;
gabriel4211 12:d32975c44c98 32 //Mutex _keyMutex;
gabriel4211 12:d32975c44c98 33 int bla = 0;
armdran 11:e12aae7de530 34 uint8_t spi_reply_blocking(uint8_t reply = 0x00, bool sendIr = 0) {
armdran 11:e12aae7de530 35 device.reply(reply);
gabriel4211 12:d32975c44c98 36 bla= 0;
gabriel4211 12:d32975c44c98 37 if(sendIr == 1) {
gabriel4211 12:d32975c44c98 38 ir = 1; ir = 0;
gabriel4211 12:d32975c44c98 39 }
gabriel4211 12:d32975c44c98 40 while(!device.receive()) {
gabriel4211 12:d32975c44c98 41 /*bla++;
gabriel4211 12:d32975c44c98 42 if(bla % 100000 == 0){
gabriel4211 12:d32975c44c98 43 printf("stuck... ");
gabriel4211 12:d32975c44c98 44 }*/
gabriel4211 12:d32975c44c98 45 }
armdran 11:e12aae7de530 46 uint8_t instruction = device.read();
armdran 11:e12aae7de530 47 //printf(" send: %x received: %x\r\n", reply, instruction);
armdran 11:e12aae7de530 48 return instruction;
armdran 11:e12aae7de530 49 }
armdran 11:e12aae7de530 50
samux 0:88d52e197201 51
armdran 8:f8122ca2f58f 52 void onKeyMod(uint8_t key, uint8_t modifier) {
gabriel4211 12:d32975c44c98 53 //printf("got key: %x modifier: %x.\r\n", key, modifier);
gabriel4211 12:d32975c44c98 54 //_keyMutex.lock();
gabriel4211 12:d32975c44c98 55 /*
gabriel4211 12:d32975c44c98 56 _keyQueue.push(key);
gabriel4211 12:d32975c44c98 57 _keyQueue.push(modifier);
gabriel4211 12:d32975c44c98 58 */
gabriel4211 12:d32975c44c98 59
gabriel4211 12:d32975c44c98 60 keyPress_t *keypress = mpool.alloc();
gabriel4211 12:d32975c44c98 61 keypress->key = key;
gabriel4211 12:d32975c44c98 62 keypress->modifier = modifier;
gabriel4211 12:d32975c44c98 63 _keyQueue.put(keypress);
gabriel4211 12:d32975c44c98 64
gabriel4211 12:d32975c44c98 65 //_keyMutex.unlock();
gabriel4211 12:d32975c44c98 66 /*
gabriel4211 12:d32975c44c98 67 ir = 1; ir = 0;
gabriel4211 12:d32975c44c98 68 uint8_t sync = 0;
gabriel4211 12:d32975c44c98 69 do{
gabriel4211 12:d32975c44c98 70 sync = spi_reply_blocking(0xFD);
gabriel4211 12:d32975c44c98 71 }while(sync != 0xFD);
gabriel4211 12:d32975c44c98 72 */
gabriel4211 12:d32975c44c98 73 /*
armdran 11:e12aae7de530 74 uint8_t instruction = spi_reply_blocking(key, 1);
gabriel4211 12:d32975c44c98 75
armdran 11:e12aae7de530 76 while(instruction != 0xFE) {
armdran 11:e12aae7de530 77 printf(" out of sync.\r\n");
gabriel4211 12:d32975c44c98 78 instruction = spi_reply_blocking(key);
gabriel4211 12:d32975c44c98 79 //return;
armdran 11:e12aae7de530 80 }
armdran 11:e12aae7de530 81
armdran 11:e12aae7de530 82 //printf(" got instruction FE. key sent\r\n");
armdran 11:e12aae7de530 83 uint8_t ack_key = spi_reply_blocking(modifier);
gabriel4211 12:d32975c44c98 84
gabriel4211 12:d32975c44c98 85
gabriel4211 12:d32975c44c98 86
gabriel4211 12:d32975c44c98 87 //printf(" mod sent.\r\n");
gabriel4211 12:d32975c44c98 88 uint8_t ack_modifier = spi_reply_blocking();
gabriel4211 12:d32975c44c98 89
armdran 11:e12aae7de530 90 if(ack_key != key)
armdran 11:e12aae7de530 91 printf(" key ack failed (is %x, should be %x)!!!\r\n", ack_key, key);
armdran 11:e12aae7de530 92 else
armdran 11:e12aae7de530 93 printf(" key ack ok\r\n");
gabriel4211 12:d32975c44c98 94
armdran 11:e12aae7de530 95 if(ack_modifier != modifier)
armdran 11:e12aae7de530 96 printf(" mod ack failed(is %x, should be %x)!!!\r\n", ack_modifier, modifier);
armdran 11:e12aae7de530 97 else
armdran 11:e12aae7de530 98 printf(" mod ack ok\r\n");
gabriel4211 12:d32975c44c98 99 */
armdran 8:f8122ca2f58f 100 }
armdran 8:f8122ca2f58f 101
gabriel4211 12:d32975c44c98 102 void spi_task(void const *) {
gabriel4211 12:d32975c44c98 103 while(1){
gabriel4211 12:d32975c44c98 104 //_keyMutex.lock();
gabriel4211 12:d32975c44c98 105 osEvent evt = _keyQueue.get();
gabriel4211 12:d32975c44c98 106 if (evt.status == osEventMessage) {
gabriel4211 12:d32975c44c98 107 keyPress_t *keypress = (keyPress_t*)evt.value.p;
gabriel4211 12:d32975c44c98 108 /*
gabriel4211 12:d32975c44c98 109 uint8_t key = _keyQueue.front();
gabriel4211 12:d32975c44c98 110 _keyQueue.pop();
gabriel4211 12:d32975c44c98 111 uint8_t modifier = _keyQueue.front();
gabriel4211 12:d32975c44c98 112 _keyQueue.pop();
gabriel4211 12:d32975c44c98 113 */
gabriel4211 12:d32975c44c98 114 uint8_t key = keypress->key;
gabriel4211 12:d32975c44c98 115 uint8_t modifier = keypress->modifier;
gabriel4211 12:d32975c44c98 116
gabriel4211 12:d32975c44c98 117 printf(" sending key %x and modifier %x %c \r\n", key, modifier, keymap[key]);
gabriel4211 12:d32975c44c98 118 uint8_t instruction = spi_reply_blocking(key, 1);
gabriel4211 12:d32975c44c98 119
gabriel4211 12:d32975c44c98 120 while(instruction != 0xFE) {
gabriel4211 12:d32975c44c98 121 printf(" out of sync.\r\n");
gabriel4211 12:d32975c44c98 122 instruction = spi_reply_blocking(key);
gabriel4211 12:d32975c44c98 123 //return;
gabriel4211 12:d32975c44c98 124 }
gabriel4211 12:d32975c44c98 125
gabriel4211 12:d32975c44c98 126 uint8_t ack_key = spi_reply_blocking(modifier);
gabriel4211 12:d32975c44c98 127
gabriel4211 12:d32975c44c98 128 uint8_t ack_modifier = spi_reply_blocking(keymap[key]);
gabriel4211 12:d32975c44c98 129
gabriel4211 12:d32975c44c98 130 uint8_t ack_keychar = spi_reply_blocking();
gabriel4211 12:d32975c44c98 131
gabriel4211 12:d32975c44c98 132 if(ack_key != key)
gabriel4211 12:d32975c44c98 133 printf(" key ack failed (is %x, should be %x)!!!\r\n", ack_key, key);
gabriel4211 12:d32975c44c98 134 else
gabriel4211 12:d32975c44c98 135 printf(" key ack ok\r\n");
gabriel4211 12:d32975c44c98 136
gabriel4211 12:d32975c44c98 137 if(ack_modifier != modifier)
gabriel4211 12:d32975c44c98 138 printf(" mod ack failed(is %x, should be %x)!!!\r\n", ack_modifier, modifier);
gabriel4211 12:d32975c44c98 139 else
gabriel4211 12:d32975c44c98 140 printf(" mod ack ok\r\n");
gabriel4211 12:d32975c44c98 141
gabriel4211 12:d32975c44c98 142 if(ack_modifier != modifier)
gabriel4211 12:d32975c44c98 143 printf(" keychar failed(is %x, should be %x)!!!\r\n", ack_keychar, keymap[key]);
gabriel4211 12:d32975c44c98 144 else
gabriel4211 12:d32975c44c98 145 printf(" keychar ack ok\r\n");
gabriel4211 12:d32975c44c98 146
gabriel4211 12:d32975c44c98 147 mpool.free(keypress);
gabriel4211 12:d32975c44c98 148
gabriel4211 12:d32975c44c98 149 }
gabriel4211 12:d32975c44c98 150 //wait_ms(1);
gabriel4211 12:d32975c44c98 151 //_keyMutex.unlock();
gabriel4211 12:d32975c44c98 152
gabriel4211 12:d32975c44c98 153 }
gabriel4211 12:d32975c44c98 154 }
armdran 8:f8122ca2f58f 155
samux 0:88d52e197201 156 void keyboard_task(void const *) {
samux 0:88d52e197201 157
samux 0:88d52e197201 158 USBHostKeyboard keyboard;
samux 0:88d52e197201 159
samux 0:88d52e197201 160 while(1) {
armdran 8:f8122ca2f58f 161
armdran 8:f8122ca2f58f 162 printf("trying to connect\r\n");
armdran 8:f8122ca2f58f 163
samux 0:88d52e197201 164 // try to connect a USB keyboard
armdran 8:f8122ca2f58f 165 while(!keyboard.connect()) {
samux 0:88d52e197201 166 Thread::wait(500);
armdran 8:f8122ca2f58f 167 }
armdran 8:f8122ca2f58f 168
armdran 8:f8122ca2f58f 169 printf("connected\r\n");
armdran 8:f8122ca2f58f 170
samux 0:88d52e197201 171 // when connected, attach handler called on keyboard event
armdran 8:f8122ca2f58f 172 keyboard.attach(onKeyMod);
armdran 8:f8122ca2f58f 173
armdran 8:f8122ca2f58f 174 printf("eventhandler attached\r\n");
samux 0:88d52e197201 175
samux 0:88d52e197201 176 // wait until the keyboard is disconnected
armdran 8:f8122ca2f58f 177 while(keyboard.connected()) {
armdran 8:f8122ca2f58f 178 USBHost::poll();
gabriel4211 12:d32975c44c98 179 //wait_ms(1);
armdran 8:f8122ca2f58f 180 }
armdran 8:f8122ca2f58f 181
armdran 8:f8122ca2f58f 182 printf("disconnected\r\n");
armdran 8:f8122ca2f58f 183
samux 0:88d52e197201 184 }
samux 0:88d52e197201 185 }
samux 0:88d52e197201 186
samux 0:88d52e197201 187 int main() {
gabriel4211 12:d32975c44c98 188 ir = 0;
samux 0:88d52e197201 189 Thread keyboardTask(keyboard_task, NULL, osPriorityNormal, 256 * 4);
gabriel4211 12:d32975c44c98 190 Thread spiTask(spi_task, NULL, osPriorityNormal, 256 * 4);
armdran 9:8bcd70b26084 191 device.frequency(1000000);
armdran 11:e12aae7de530 192 device.format(8, 1);
armdran 11:e12aae7de530 193 while(1) {}
armdran 9:8bcd70b26084 194
samux 0:88d52e197201 195 }