projects/example1/main.c

   1 #include <stdio.h>
   2 #include <string.h>
   3
   4 #include <aversive/wait.h>
   5 #include <aversive/list.h>
   6 #include <uart.h>
   7
   8
   9 LIST_TYPEDEF(fifo_t, char, 32);
  10 volatile fifo_t my_fifo;
  11
  12 #define SCANCODE_MAX_SIZE 8
  13
  14 #define SCANCODE_BREAK        1 /* break code */
  15 #define SCANCODE_EXTENDED     2 /* is extended */
  16 #define SCANCODE_HAS_NO_BREAK 4 /* no associated break code */
  17
  18 struct scancode {
  19         uint8_t buf[SCANCODE_MAX_SIZE];
  20         uint8_t size;
  21         uint8_t idx;
  22         uint8_t flags;
  23 };
  24
  25 char tab[] = {
  26         /***** 0x00 */
  27         0,
  28         0,  /* F9 */
  29         0,
  30         0,  /* F5 */
  31         0,  /* F3 */
  32         0,  /* F1 */
  33         0,  /* F2 */
  34         0,  /* F12 */
  35         0,
  36         0,  /* F10 */
  37         0,  /* F8 */
  38         0,  /* F6 */
  39         0,  /* F4 */
  40         0,  /* TAB */
  41         'E',  /* E */
  42         0,
  43
  44         /***** 0x10 */
  45         0,
  46         0,  /* AltL */
  47         0,  /* ShiftL */
  48         0,
  49         0,  /* CtrlL */
  50         'Q',  /* Q */
  51         '1',  /* 1 */
  52         0,
  53         0,
  54         0,
  55         'Z',  /* Z */
  56         'S',  /* S */
  57         'A',  /* A */
  58         'W',  /* W */
  59         '2',  /* 2 */
  60         0,
  61
  62         /***** 0x20 */
  63         0,
  64         'C',  /* C */
  65         'X',  /* X */
  66         'D',  /* D */
  67         'E',  /* E */
  68         '4',  /* 4 */
  69         '3',  /* 3 */
  70         0,
  71         0,
  72         0,  /* Space */
  73         'V',  /* V */
  74         'F',  /* F */
  75         'T',  /* T */
  76         'R',  /* R */
  77         '5',  /* 5 */
  78         0,
  79
  80         /***** 0x30 */
  81         0,
  82         'N',  /* N */
  83         'B',  /* B */
  84         'H',  /* H */
  85         'G',  /* G */
  86         'Y',  /* Y */
  87         '6',  /* 6 */
  88         0,
  89         0,
  90         0,
  91         'M',  /* M */
  92         'J',  /* J */
  93         'U',  /* U */
  94         '7',  /* 7 */
  95         '8',  /* 8 */
  96         0,
  97
  98         /***** 0x40 */
  99         0,
 100         '<',  /* < */
 101         'K',  /* K */
 102         'I',  /* I */
 103         'O',  /* O */
 104         '0',  /* 0 */
 105         '9',  /* 9 */
 106         0,
 107         0,
 108         '>',  /* > */
 109         '?',  /* ? */
 110         'L',  /* L */
 111         ':',  /* : */
 112         'P',  /* P */
 113         '-',  /* - */
 114         0,
 115
 116         /***** 0x50 */
 117         0,
 118         0,
 119         '"',  /* " */
 120         0,
 121         '[',  /* [ */
 122         'a',  /* a */
 123         0,
 124         0,
 125         0,  /* CapsLk */
 126         0,  /* ShiftR */
 127         0,  /* EnterL */
 128         ']',  /* ] */
 129         0,
 130         '\\',  /* \\ */
 131         0,
 132         0,
 133
 134         /***** 0x60 */
 135         0,
 136         0,  /* Macro */
 137         0,
 138         0,
 139         0,
 140         0,
 141         0,  /* BS */
 142         0,
 143         0,
 144         '1',  /* 1 */
 145         0,
 146         '4',  /* 4 */
 147         '7',  /* 7 */
 148         0,
 149         0,
 150         0,
 151
 152         /***** 0x70 */
 153         '0',  /* 0 */
 154         0,  /* Del */
 155         '2',  /* 2 */
 156         '5',  /* 5 */
 157         '6',  /* 6 */
 158         '8',  /* 8 */
 159         0,  /* Esc */
 160         0,  /* NumLk */
 161         0,  /* F11 */
 162         '+',  /* + */
 163         '3',  /* 3 */
 164         '-',  /* - */
 165         '*',  /* * */
 166         '9',  /* 9 */
 167         0,  /* ScrLk */
 168         0,
 169
 170         /***** 0x80 */
 171         0,
 172         0,
 173         0,
 174         0,  /* F7 */
 175         0,  /* Alt-PRTSC */
 176
 177 #define SCANCODE_EXTENDED_LIST               "\x11\x14\x4A\x5A\x69\x6B\x6C\x70\x71\x72\x74\x75\x7A\x7C\x7D"
 178 #define SCANCODE_EXTENDED_LIST_SIZE          15
 179 #define SCANCODE_EXTENDED_LIST_OFFSET        0x85
 180
 181         0, /* 0x0E11 AltR */
 182         0, /* 0x0E14 CtrlR */
 183         0, /* 0x0E4A / */
 184         0, /* 0x0E5A Enter */
 185         0, /* 0x0E69 End */
 186         0, /* 0x0E6B Left */
 187         0, /* 0x0E6C Home */
 188         0, /* 0x0E70 Insert */
 189         0, /* 0x0E71 Delete */
 190         0, /* 0x0E72 Down */
 191         0, /* 0x0E74 Right */
 192
 193         /***** 0x90 */
 194         0, /* 0x0E75 Up */
 195         0, /* 0x0E7A Pgdn */
 196         0, /* 0x0E7C Ctrl-Prtscr */
 197         0, /* 0x0E7D Pgup */
 198
 199
 200
 201         /* Exceptions */
 202
 203 #define SCANCODE_VAL_PAUSE                    "\xE1\x14\x77\xE1\xF0\x14\xF0\x77"
 204 #define SCANCODE_VAL_PAUSE_SIZE               8
 205 #define SCANCODE_VAL_PAUSE_OFFSET             0
 206
 207 #define SCANCODE_VAL_PRTSCR_BREAK             "\xE0\xF0\x12\xE0\xF0\x7C"
 208 #define SCANCODE_VAL_PRTSCR_BREAK_SIZE        6
 209 #define SCANCODE_VAL_PRTSCR_BREAK_OFFSET      1
 210
 211 #define SCANCODE_VAL_CTRL_PAUSE               "\xE0\x7E\xE0\xF0\x7E"
 212 #define SCANCODE_VAL_CTRL_PAUSE_SIZE          5
 213 #define SCANCODE_VAL_CTRL_PAUSE_OFFSET        2
 214
 215 #define SCANCODE_VAL_SHIFT_SLASH              "\xE0\xF0\x12\xE0\x4A"
 216 #define SCANCODE_VAL_SHIFT_SLASH_SIZE         5
 217 #define SCANCODE_VAL_SHIFT_SLASH_OFFSET       3
 218
 219 #define SCANCODE_VAL_SHIFT_SLASH_BREAK        "\xE0\xF0\x4A\xE0\x12"
 220 #define SCANCODE_VAL_SHIFT_SLASH_BREAK_SIZE   5
 221 #define SCANCODE_VAL_SHIFT_SLASH_BREAK_OFFSET 3
 222
 223 #define SCANCODE_VAL_PRTSCR                   "\xE0\x12\xE0\x7C"
 224 #define SCANCODE_VAL_PRTSCR_SIZE              4
 225 #define SCANCODE_VAL_PRTSCR_OFFSET            1
 226
 227
 228         0, /* E11477E1F014F077 PAUSE */
 229         0, /* E012E07C PRTSCR */
 230         0, /* E07EE0F07E CTRL_PAUSE */
 231         0, /* E0F012E04A SHIFT_SLASH */
 232         0, /* E012E07C */
 233 };
 234
 235 char * scancode_extended_list = SCANCODE_EXTENDED_LIST;
 236
 237
 238
 239
 240 int8_t get_scancode(struct scancode *s)
 241 {
 242         char * p;
 243
 244         s->flags = 0;
 245         s->size = LIST_TO_ARRAY(my_fifo, s->buf, SCANCODE_MAX_SIZE);
 246         printf("%d\n", s->size);
 247
 248         if (!s->size)
 249                 return -1;
 250
 251         /* special case for 'pause' */
 252         if (s->size >=  SCANCODE_VAL_PAUSE_SIZE &&
 253             !memcmp(SCANCODE_VAL_PAUSE, s->buf, SCANCODE_VAL_PAUSE_SIZE)) {
 254                 s->flags |= (SCANCODE_EXTENDED | SCANCODE_HAS_NO_BREAK);
 255                 s->size = SCANCODE_VAL_PAUSE_SIZE;
 256                 s->idx = SCANCODE_EXTENDED_LIST_OFFSET + SCANCODE_EXTENDED_LIST_SIZE + SCANCODE_VAL_PAUSE_OFFSET;
 257                 return 0;
 258         }
 259
 260
 261         /* extended codes */
 262         if (s->buf[0] == 0xE0 && s->size >= 2) {
 263                 s->flags |= SCANCODE_EXTENDED;
 264
 265                 /* special case for 'prtscr break' */
 266                 if (s->size >=  SCANCODE_VAL_PRTSCR_BREAK_SIZE &&
 267                     !memcmp(SCANCODE_VAL_PRTSCR_BREAK, s->buf, SCANCODE_VAL_PRTSCR_BREAK_SIZE)) {
 268                         s->flags |= SCANCODE_BREAK;
 269                         s->size = SCANCODE_VAL_PRTSCR_BREAK_SIZE;
 270                         s->idx = SCANCODE_EXTENDED_LIST_OFFSET + SCANCODE_EXTENDED_LIST_SIZE + SCANCODE_VAL_PRTSCR_BREAK_OFFSET;
 271                         return 0;
 272                 }
 273
 274                 /* special case for 'ctrl_pause' */
 275                 if (s->size >=  SCANCODE_VAL_CTRL_PAUSE_SIZE &&
 276                     !memcmp(SCANCODE_VAL_CTRL_PAUSE, s->buf, SCANCODE_VAL_CTRL_PAUSE_SIZE)) {
 277                         s->flags |= SCANCODE_HAS_NO_BREAK;
 278                         s->size = SCANCODE_VAL_CTRL_PAUSE_SIZE;
 279                         s->idx = SCANCODE_EXTENDED_LIST_OFFSET + SCANCODE_EXTENDED_LIST_SIZE + SCANCODE_VAL_CTRL_PAUSE_OFFSET;
 280                         return 0;
 281                 }
 282
 283                 /* special case for 'shift_slash' */
 284                 if (s->size >=  SCANCODE_VAL_SHIFT_SLASH_SIZE &&
 285                     !memcmp(SCANCODE_VAL_SHIFT_SLASH, s->buf, SCANCODE_VAL_SHIFT_SLASH_SIZE)) {
 286                         s->size = SCANCODE_VAL_SHIFT_SLASH_SIZE;
 287                         s->idx = SCANCODE_EXTENDED_LIST_OFFSET + SCANCODE_EXTENDED_LIST_SIZE + SCANCODE_VAL_SHIFT_SLASH_OFFSET;
 288                         return 0;
 289                 }
 290
 291                 /* special case for 'shift_slash_break' */
 292                 if (s->size >=  SCANCODE_VAL_SHIFT_SLASH_BREAK_SIZE &&
 293                     !memcmp(SCANCODE_VAL_SHIFT_SLASH_BREAK, s->buf, SCANCODE_VAL_SHIFT_SLASH_BREAK_SIZE)) {
 294                         s->flags |= SCANCODE_BREAK;
 295                         s->size = SCANCODE_VAL_SHIFT_SLASH_BREAK_SIZE;
 296                         s->idx = SCANCODE_EXTENDED_LIST_OFFSET + SCANCODE_EXTENDED_LIST_SIZE + SCANCODE_VAL_SHIFT_SLASH_BREAK_OFFSET;
 297                         return 0;
 298                 }
 299
 300                 /* special case for 'prtscr' */
 301                 if (s->size >=  SCANCODE_VAL_PRTSCR_SIZE &&
 302                     !memcmp(SCANCODE_VAL_PRTSCR, s->buf, SCANCODE_VAL_PRTSCR_SIZE)) {
 303                         s->size = SCANCODE_VAL_PRTSCR_SIZE;
 304                         s->idx = SCANCODE_EXTENDED_LIST_OFFSET +SCANCODE_EXTENDED_LIST_SIZE +  SCANCODE_VAL_PRTSCR_OFFSET;
 305                         return 0;
 306                 }
 307
 308                 /* break for extended codes */
 309                 if (s->size >= 3 && s->buf[1] == 0xF0) {
 310                         s->flags |= SCANCODE_BREAK;
 311                         s->size = 3;
 312                         p = strchr(scancode_extended_list, s->buf[2]);
 313                         if (!p)
 314                                 return -1;
 315                         s->idx = (p - scancode_extended_list) + SCANCODE_EXTENDED_LIST_OFFSET;
 316                         return 0;
 317                 }
 318
 319                 /* ext scancode, 2 bytes */
 320                 s->size = 2;
 321                 p = strchr(scancode_extended_list, s->buf[2]);
 322                 if (!p)
 323                         return -1;
 324                 s->idx = (p - scancode_extended_list) + SCANCODE_EXTENDED_LIST_OFFSET;
 325                 return 0;
 326         }
 327
 328         /* break scancode (2 bytes) */
 329         if (s->buf[0] == 0xF0) {
 330                 s->flags |= SCANCODE_BREAK;
 331                 s->size = 2;
 332                 s->idx = s->buf[1];
 333                 if (s->idx >= SCANCODE_EXTENDED_LIST_OFFSET)
 334                         return -1;
 335                 return 0;
 336         }
 337
 338         /* simple scancode, 1 byte */
 339         s->idx = s->buf[0];
 340         if (s->idx >= SCANCODE_EXTENDED_LIST_OFFSET)
 341                 return -1;
 342
 343         s->size = 1;
 344         return 0;
 345 }
 346
 347 void print_scancode(struct scancode *s)
 348 {
 349         uint8_t i;
 350         printf("[ ");
 351         for (i=0 ; i<s->size ; i++)
 352                 printf("%.2x ", s->buf[i]);
 353         printf("] '%c' ", tab[s->idx]);
 354         if (s->flags & SCANCODE_BREAK)
 355                 printf("BREAK ");
 356         if (s->flags & SCANCODE_EXTENDED)
 357                 printf("EXTENDED ");
 358         if (s->flags & SCANCODE_HAS_NO_BREAK)
 359                 printf("HAS_NO_BREAK ");
 360         printf("idx=%d\r\n", s->idx);
 361 }
 362
 363 int main(void)
 364 {
 365         struct scancode s;
 366         char c;
 367
 368         LIST_INIT(my_fifo, 0);
 369
 370         LIST_PUSH_END(my_fifo, 0x35);
 371         LIST_PUSH_END(my_fifo, 0xF0);
 372         LIST_PUSH_END(my_fifo, 0x35);
 373
 374         LIST_PUSH_END(my_fifo, 0xE1);
 375         LIST_PUSH_END(my_fifo, 0x14);
 376         LIST_PUSH_END(my_fifo, 0x77);
 377         LIST_PUSH_END(my_fifo, 0xE1);
 378         LIST_PUSH_END(my_fifo, 0xF0);
 379         LIST_PUSH_END(my_fifo, 0x14);
 380         LIST_PUSH_END(my_fifo, 0xF0);
 381         LIST_PUSH_END(my_fifo, 0x77);
 382
 383         LIST_PUSH_END(my_fifo, 0xE0);
 384         LIST_PUSH_END(my_fifo, 0xF0);
 385         LIST_PUSH_END(my_fifo, 0x12);
 386         LIST_PUSH_END(my_fifo, 0xE0);
 387         LIST_PUSH_END(my_fifo, 0x4A);
 388
 389         LIST_PUSH_END(my_fifo, 0xE0);
 390         LIST_PUSH_END(my_fifo, 0xF0);
 391         LIST_PUSH_END(my_fifo, 0x11);
 392
 393
 394
 395         while(get_scancode(&s) >= 0) {
 396                 print_scancode(&s);
 397                 while(s.size--)
 398                         LIST_PULL_START(my_fifo, &c);
 399         }
 400
 401         return 0;
 402 }