common/action_macro.c

   1 /*
   2 Copyright 2013 Jun Wako <wakojun@gmail.com>
   3
   4 This program is free software: you can redistribute it and/or modify
   5 it under the terms of the GNU General Public License as published by
   6 the Free Software Foundation, either version 2 of the License, or
   7 (at your option) any later version.
   8
   9 This program is distributed in the hope that it will be useful,
  10 but WITHOUT ANY WARRANTY; without even the implied warranty of
  11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12 GNU General Public License for more details.
  13
  14 You should have received a copy of the GNU General Public License
  15 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  16 */
  17 #include <util/delay.h>
  18 #include "debug.h"
  19 #include "action.h"
  20 #include "action_macro.h"
  21
  22
  23 #define MACRO_READ()  (macro = pgm_read_byte(macro_p++))
  24 void action_macro_play(const prog_macro_t *macro_p)
  25 {
  26     macro_t macro = END;
  27     uint8_t interval = 0;
  28
  29     if (!macro_p) return;
  30     while (true) {
  31         switch (MACRO_READ()) {
  32             case INTERVAL:
  33                 interval = MACRO_READ();
  34                 debug("INTERVAL("); debug_dec(interval); debug(")\n");
  35                 break;
  36             case WAIT:
  37                 MACRO_READ();
  38                 debug("WAIT("); debug_dec(macro); debug(")\n");
  39                 { uint8_t ms = macro; while (ms--) _delay_ms(1); }
  40                 break;
  41             case MODS_DOWN:
  42                 MACRO_READ();
  43                 debug("MODS_DOWN("); debug_hex(macro); debug(")\n");
  44                 add_mods(macro);
  45                 break;
  46             case MODS_UP:
  47                 MACRO_READ();
  48                 debug("MODS_UP("); debug_hex(macro); debug(")\n");
  49                 del_mods(macro);
  50                 break;
  51             case 0x04 ... 0x73:
  52                 debug("DOWN("); debug_hex(macro); debug(")\n");
  53                 register_code(macro);
  54                 break;
  55             case 0x84 ... 0xF3:
  56                 debug("UP("); debug_hex(macro); debug(")\n");
  57                 unregister_code(macro&0x7F);
  58                 break;
  59             case END:
  60             default:
  61                 return;
  62         }
  63         // interval
  64         { uint8_t ms = interval; while (ms--) _delay_ms(1); }
  65     }
  66 }