ROM2/main_basic.c

   1 /*
   2  * main_basic.c - a simplified main procedure that relies upon a ersver to do
   3  * anything smart. Just be a dumb interface to a display, keypad, coin mech
   4  * and snacks.
   5  */
   6
   7 #include "version.h"
   8 #include "display_basic.h"
   9 #include "keypad.h"
  10 #include "chime.h"
  11 #include "coinmech.h"
  12 #include "motors.h"
  13 #include "sci.h"
  14 #include "vend.h"
  15 #include "xmodem.h"
  16 #include "mic.h"
  17
  18 u8 last_standalone;
  19 u8 last_switch_input;
  20 u8 last_misc_input;
  21 u16 last_coin_value;
  22 bool last_door_open;
  23 char display_buf[11];
  24 /* cur_motor[0] is 0 for nothing, or 1..10, or 0xff to say redraw.
  25  * cur_motor[1] is 0..9 and only meaningful is cur_motor[0] != 0. */
  26 u8 cur_motor[2];
  27
  28 bool check_standalone() {
  29         if (is_standalone()) {
  30                 send_string("011 In standalone mode. Function disabled." CRLF);
  31                 return 1;
  32         }
  33         return 0;
  34 }
  35
  36 bool check_badpoke() {
  37         if (cant_poke()) {
  38                 send_string("099 Can't poke without flipping DIP SW 3." CRLF);
  39                 return 1;
  40         }
  41         return 0;
  42 }
  43
  44 void unknown_command() {
  45         send_string("012 Unknown command. Type HELP for help." CRLF);
  46 }
  47
  48 void motor_reply(u8 code) {
  49         /* returns a message of the form MXYY - X is return code, YY is motor */
  50         switch (code) {
  51                 case MOTOR_SUCCESS:
  52                         send_string("100 Vend successful." CRLF);
  53                         break;
  54                 case MOTOR_NOSLOT:
  55                         send_string("151 No motor there." CRLF);
  56                         break;
  57                 case MOTOR_CURRENT_FAIL:
  58                         send_string("152 Over current." CRLF);
  59                         break;
  60                 case MOTOR_HOME_FAIL:
  61                         send_string("153 Home sensors failing." CRLF);
  62                         break;
  63                 default:
  64                         send_string("159 Unknown motor error." CRLF);
  65         }
  66 }
  67
  68 void dispense_something() {
  69         /* process a message VXX in sci_rx_buf where XX is motor number */
  70         u8 slot;
  71
  72         if (check_standalone()) return;
  73         if (must_verify() && !mic_verify((void*)sci_rx_buf)) {
  74                 send_string("019 Message verification failed." CRLF);
  75                 return;
  76         }
  77
  78         if (my_strncmp("ALL", (char*)sci_rx_buf+1, 3)) {
  79                 char motor[3];
  80                 motor[2] = '\0';
  81                 send_string("102 Vend all motors starting." CRLF);
  82                 for (motor[0] = '0'; motor[0] <= '9'; motor[0]++) {
  83                         for (motor[1] = '0'; motor[1] <= '9'; motor[1]++) {
  84                                 if (motor[1] == '5') continue; /* there is now row 5 */
  85                                 send_string("101 Vending ");
  86                                 send_string(motor);
  87                                 send_string(CRLF);
  88                                 motor_reply(dispense_motor((motor[0]-'0')*10+(motor[1]-'0')));
  89                         }
  90                 }
  91                 send_string("102 Vend all motors complete." CRLF);
  92                 return;
  93         }
  94
  95         if ((sci_rx_buf[1] < '0') || (sci_rx_buf[1] > '9') ||
  96                 (sci_rx_buf[2] < '0') || (sci_rx_buf[2] > '9')) {
  97                 sci_rx_buf[1] = sci_rx_buf[2] = '0';
  98                 motor_reply(MOTOR_NOSLOT);
  99                 return;
 100         }
 101
 102         slot = (sci_rx_buf[1] - '0') * 10;
 103         slot += sci_rx_buf[2] - '0';
 104
 105         motor_reply(dispense_motor(slot));
 106 }
 107
 108 void write_to_display() {
 109         /* process a message in the form DXXXXXXXXXX to send to display */
 110         u8 i;
 111         char buf[11];
 112
 113         if (check_standalone()) return;
 114
 115         for (i = 0; i < 10; i++)
 116                 if (sci_rx_buf[i+1])
 117                         buf[i] = sci_rx_buf[i+1];
 118                 else
 119                         break;
 120
 121         for (; i < 10; i++) /* pad the rest out with spaces */
 122                 buf[i] = ' ';
 123         buf[i] = '\0';
 124
 125         set_msg(buf);
 126         send_string("300 Written." CRLF);
 127 }
 128
 129 void send_balance() {
 130         sci_tx_buf[0] = 'C';
 131         sci_tx_buf[1] = have_change?'0':'1';
 132         sci_tx_buf[2] = (coin_value/10000)%10;
 133         sci_tx_buf[3] = (coin_value/1000)%10;
 134         sci_tx_buf[4] = (coin_value/100)%10;
 135         sci_tx_buf[5] = (coin_value/10)%10;
 136         sci_tx_buf[6] = coin_value%10;
 137         sci_tx_buf[8] = 0;
 138         send_buffer(1);
 139 }
 140
 141 void give_change() {
 142         u16 cost;
 143
 144         if ((sci_rx_buf[1] < '0') || (sci_rx_buf[1] > '9') ||
 145                 (sci_rx_buf[2] < '0') || (sci_rx_buf[2] > '9') ||
 146                 (sci_rx_buf[3] < '0') || (sci_rx_buf[3] > '9') ||
 147                 (sci_rx_buf[4] < '0') || (sci_rx_buf[4] > '9') ||
 148                 (sci_rx_buf[5] < '0') || (sci_rx_buf[5] > '9')) {
 149                 //send_nack();
 150         }
 151         cost = sci_rx_buf[1] - '0';
 152         cost *= 10; cost = sci_rx_buf[2] - '0';
 153         cost *= 10; cost = sci_rx_buf[3] - '0';
 154         cost *= 10; cost = sci_rx_buf[4] - '0';
 155         cost *= 10; cost = sci_rx_buf[5] - '0';
 156
 157         coin_cost(cost);
 158         //send_ack();
 159 }
 160
 161 void send_keypress(u8 key) {
 162         /* send a packet of the form KX with X being the key, or R for reset */
 163         if (is_standalone()) return;
 164
 165         sci_tx_buf[0] = '2';
 166         if (key == KEY_RESET) {
 167                 sci_tx_buf[1] = '1';
 168                 sci_tx_buf[2] = '1';
 169         } else {
 170                 sci_tx_buf[1] = '0';
 171                 sci_tx_buf[2] = (key%10)+'0';
 172         }
 173         sci_tx_buf[3] = '\0';
 174         send_buffer(0);
 175         send_string(" key." CRLF);
 176 }
 177
 178 void send_door_msg(bool open) {
 179         if (is_standalone()) return;
 180         sci_tx_buf[0] = '4';
 181         sci_tx_buf[1] = '0';
 182         sci_tx_buf[2] = open?'1':'0';
 183         send_buffer(0);
 184         if (open)
 185                 send_string(" door open." CRLF);
 186         else
 187                 send_string(" door closed." CRLF);
 188 }
 189
 190 void do_chime() {
 191         if (check_standalone()) return;
 192         if (sci_rx_buf[1] == '\0')
 193                 chime_start();
 194         else if (sci_rx_buf[1] == 'S') { /* synchronous beep */
 195                 if (sci_rx_buf[2] == '\0')
 196                         chime_start();
 197                 else if (sci_rx_buf[3] != '\0' && sci_rx_buf[4] == '\0')
 198                         chime_for(hex2u8(sci_rx_buf[2], sci_rx_buf[3]));
 199                 else {
 200                         send_string("510 Unknown chime duration." CRLF);
 201                         return;
 202                 }
 203                 while (chime_count); /* spin */
 204                 send_string("500 Chimed." CRLF);
 205                 return;
 206         } else if (sci_rx_buf[2] != '\0' && sci_rx_buf[3] == '\0')
 207                 chime_for(hex2u8(sci_rx_buf[1], sci_rx_buf[2]));
 208         else {
 209                 send_string("510 Unknown chime duration." CRLF);
 210                 return;
 211         }
 212         send_string("500 Chime started." CRLF);
 213         return;
 214 }
 215
 216 void do_silence() {
 217         if (check_standalone()) return;
 218         if (sci_rx_buf[1] == '\0')
 219                 unchime_start();
 220         else if (sci_rx_buf[1] == 'S') { /* synchronous beep */
 221                 if (sci_rx_buf[2] == '\0')
 222                         unchime_start();
 223                 else if (sci_rx_buf[3] != '\0' && sci_rx_buf[4] == '\0')
 224                         unchime_for(hex2u8(sci_rx_buf[2], sci_rx_buf[3]));
 225                 else {
 226                         send_string("511 Unknown silence duration." CRLF);
 227                         return;
 228                 }
 229                 while (unchime_count); /* spin */
 230                 send_string("501 Silenced." CRLF);
 231                 return;
 232         } else if (sci_rx_buf[2] != '\0' && sci_rx_buf[3] == '\0')
 233                 unchime_for(hex2u8(sci_rx_buf[1], sci_rx_buf[2]));
 234         else {
 235                 send_string("511 Unknown silence duration." CRLF);
 236                 return;
 237         }
 238         send_string("501 Silence started." CRLF);
 239         return;
 240 }
 241
 242 void print_switches(u8 prompted) {
 243         if (prompted)
 244                 send_string("600 ");
 245         else
 246                 send_string("610 ");
 247         send_string(u82hex(misc_input));
 248         send_string(" ");
 249         send_string(u82hex(switch_input));
 250         send_string(CRLF);
 251 }
 252
 253 void ping_pong() {
 254         /* make sure it's really a ping */
 255         if (!my_strncmp("ING", (char*)sci_rx_buf+1, 3)) {
 256                 unknown_command();
 257                 return;
 258         }
 259         /* respond with ack & pong */
 260         send_string("000 PONG!" CRLF);
 261 }
 262
 263 u16 hex2addr(char* addrptr) {
 264         u16 v;
 265         v = hex2u8(addrptr[0], addrptr[1]) << 8;
 266         v |= hex2u8(addrptr[2], addrptr[3]);
 267         return v;
 268 }
 269
 270 void peek() {
 271         if (!my_strncmp("EEK", (char*)sci_rx_buf+1, 3)) {
 272                 unknown_command();
 273                 return;
 274         }
 275         if (check_badpoke()) return;
 276         if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
 277                         ishex(sci_rx_buf[7]) && sci_rx_buf[8] == '\0') {
 278                 u16 v = hex2addr((char*)(sci_rx_buf+4));
 279                 v = *((u8*)v);
 280                 send_string("090 ");
 281                 send_string(u82hex(v));
 282                 send_string(CRLF);
 283                 return;
 284         }
 285         send_string("091 Invalid location given." CRLF);
 286 }
 287
 288 void poke() {
 289         if (!my_strncmp("OKE", (char*)sci_rx_buf+1, 3)) {
 290                 unknown_command();
 291                 return;
 292         }
 293         if (check_badpoke()) return;
 294         if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
 295                         ishex(sci_rx_buf[7]) && ishex(sci_rx_buf[8]) && ishex(sci_rx_buf[9])
 296                         && sci_rx_buf[10] == '\0') {
 297                 u16 v;
 298                 v = hex2addr((char*)(sci_rx_buf+4));
 299                 *(u8*)v = hex2u8(sci_rx_buf[8], sci_rx_buf[9]);
 300                 send_string("080 Written." CRLF);
 301                 return;
 302         }
 303         send_string("081 Invalid location or byte given." CRLF);
 304 }
 305
 306 void jump() {
 307         if (!my_strncmp("UMP", (char*)sci_rx_buf+1, 3)) {
 308                 unknown_command();
 309                 return;
 310         }
 311         if (check_badpoke()) return;
 312         if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
 313                         ishex(sci_rx_buf[7]) && sci_rx_buf[8] == '\0') {
 314                 u16 v = hex2addr((char*)(sci_rx_buf+4));
 315                 send_string("070 Jumping now." CRLF);
 316                 asm volatile ("jsr %0" : : "m"(*(u16*)v) : "d");
 317                 send_string("071 And back." CRLF);
 318                 return;
 319         }
 320         send_string("079 Invalid location given." CRLF);
 321 }
 322
 323 void do_set_password() {
 324         u8 i;
 325         bool good = 1;
 326         if (check_badpoke()) return;
 327         for (i=1; i < 17; i++) {
 328                 if (sci_rx_buf[i] == '\0') {
 329                         good = 0;
 330                         break;
 331                 }
 332         }
 333         if (good && sci_rx_buf[17] != '\0') good = 0;
 334         if (!good) {
 335                 send_string("061 Password must be exactly 16 characters." CRLF);
 336                 return;
 337         }
 338
 339         mic_set_secret((char*)(sci_rx_buf+1));
 340         send_string("060 Password has been set." CRLF);
 341 }
 342
 343 void send_prompt() {
 344         if (must_verify()) {
 345                 send_string(u82hex(mic_challenge >> 8));
 346                 send_string(u82hex(mic_challenge & 0xff));
 347         }
 348         send_string(is_standalone()?"% ":"# ");
 349 }
 350
 351 void about() {
 352         if (!my_strncmp("BOUT", (char*)sci_rx_buf+1, 4)) {
 353                 unknown_command();
 354                 return;
 355         }
 356         send_string(
 357                 "------------------------------------------------------------" CRLF
 358                 " ROM2 (C) 2004 Bernard Blackham <[email protected]>" CRLF
 359                 "------------------------------------------------------------" CRLF
 360                 " Revision: " VERSION_STRING "  Built: " DATEBUILT_STRING CRLF "" CRLF CRLF
 361                 "   This snack machine was brought to you by " CRLF
 362                 "    Bernard Blackham" CRLF
 363                 "    Mark Tearle" CRLF
 364                 "    Harry McNally" CRLF
 365                 "    Michal Gornisiewicz" CRLF
 366                 "    and others." CRLF
 367                 "" CRLF
 368                 " Another UCC project in action.      http://www.ucc.asn.au/" CRLF
 369         );
 370 }
 371
 372 void set_echo() {
 373         if (my_strncmp("CHO ON", (char*)sci_rx_buf+1, 6))
 374                 sci_echo = 1;
 375         else if (my_strncmp("CHO OFF", (char*)sci_rx_buf+1, 7))
 376                 sci_echo = 0;
 377         else
 378                 unknown_command();
 379 }
 380
 381 void moo() {
 382         if (!my_strncmp("OO", (char*)sci_rx_buf+1, 2)) {
 383                 unknown_command();
 384                 return;
 385         }
 386         send_string(
 387 "       ____________" CRLF
 388 "       |__________|" CRLF
 389 "      /           /\\" CRLF
 390 "     /  U C C    /  \\" CRLF
 391 "    /___________/___/|" CRLF
 392 "    |          |     |" CRLF
 393 "    |  ==\\ /== |     |" CRLF
 394 "    |   O   O  | \\ \\ |" CRLF
 395 "    |     <    |  \\ \\|" CRLF
 396 "   /|          |   \\ \\" CRLF
 397 "  / |  \\_____/ |   / /" CRLF
 398 " / /|          |  / /|" CRLF
 399 "/||\\|          | /||\\/" CRLF
 400 "    -------------|   " CRLF
 401 "        | |    | | " CRLF
 402 "       <__/    \\__>" CRLF
 403 "" CRLF
 404 "  ... Where's the cheese?" CRLF
 405         );
 406 }
 407
 408 void help() {
 409         send_string(
 410                 "Valid commands are:" CRLF
 411                 " ABOUT         ROM information" CRLF
 412                 " B[S][nn]      beep [synchronously] for a duration nn (optional)" CRLF
 413                 " C[S][nn]      silence [synchronously] for a duration nn (optional)" CRLF
 414                 " Dxxxxxxxxxx   show a message on the display" CRLF
 415                 " ECHO {ON|OFF} turn echo on or off" CRLF
 416                 " GETROM        download the ROM source code using xmodem" CRLF
 417                 " H[...]        this help screen" CRLF
 418                 "*JUMPxxxx      jumps to a subroutine at location xxxx" CRLF
 419                 "*PEEKxxxx      returns the value of the byte at location xxxx" CRLF
 420                 "*POKExxxxyy    sets the value of location xxxx to yy" CRLF
 421                 " PING          pongs" CRLF
 422                 " S[...]        query all internal switch states" CRLF
 423                 "+Vnn           vend an item" CRLF
 424                 "+VALL          vend all items" CRLF
 425                 "*Wxxxxxxxxxxxx set a new password for authenticated vends. xxx=16 chars" CRLF
 426                 "               password will be converted to uppercase" CRLF
 427                 "" CRLF
 428                 "Very few functions are available when the machine is in standalone " CRLF
 429                 "mode (DIP SW 1 is set)" CRLF
 430                 "+ denotes that this item requires authentication if DIP SW 2 is set" CRLF
 431                 "* denotes that DIP SW 3 must be set to use these" CRLF
 432                 "Commands starting with # are ignored (comments)" CRLF
 433         );
 434 }
 435
 436 extern const char _rom_src_data[];
 437 extern const u16 _rom_src_len;
 438 void getrom() {
 439         if (!my_strncmp("ETROM", (char*)sci_rx_buf+1, 5)) {
 440                 unknown_command();
 441                 return;
 442         }
 443         char s[4];
 444
 445         u16 rom_addr;
 446         rom_addr = (u16)(&_rom_src_data);
 447
 448         send_string("Writing to serial port (maybe). Size is 0x");
 449         send_string(u82hex(_rom_src_len >> 8));
 450         send_string(u82hex(_rom_src_len & 0xff));
 451         send_string("@0x");
 452         send_string(u82hex(rom_addr >> 8));
 453         send_string(u82hex(rom_addr & 0xff));
 454         send_string(" with signature ");
 455         s[0] = _rom_src_data[0];
 456         s[1] = _rom_src_data[1];
 457         s[2] = _rom_src_data[2];
 458         s[3] = '\0';
 459         send_string(s);
 460         send_string(CRLF " Type YES to download rom.tar.bz2 via XMODEM: ");
 461         msg_clr();
 462         while (!sci_have_packet); /* spin */
 463         if (!my_strncmp("YES", (char*)sci_rx_buf, 3)) {
 464                 send_string(CRLF "Transfer cancelled." CRLF);
 465                 return;
 466         }
 467
 468         sci_init();
 469         sci_doing_xmodem = 1;
 470         if (!xmodem_init_xfer()) {
 471                 sci_doing_xmodem = 0;
 472                 send_string("XMODEM init failed. Nobody's listening :(" CRLF);
 473                 return;
 474         }
 475         char *p = (char*)_rom_src_data;
 476         char *end = (char*)_rom_src_data+_rom_src_len;
 477         bool aborted = 0;
 478         while (1) {
 479                 if (p + 128 > end) {
 480                         /* send partial packet */
 481                         if (!xmodem_send_packet((char*)p, end-p)) aborted = 1;
 482                         break;
 483                 } if ((u16)p == 0xb600) {
 484                         /* we have an eeprom here. skip it. */
 485                         p += 0x0200;
 486                         continue;
 487                 } else if (!xmodem_send_packet((char*)p, 128)) {
 488                         aborted = 1;
 489                         break;
 490                 }
 491                 p += 128;
 492         }
 493
 494         xmodem_finish_xfer();
 495         sci_doing_xmodem = 0;
 496         if (aborted)
 497                 send_string(CRLF "Transfer aborted." CRLF);
 498         else
 499                 send_string(CRLF "Transfer complete." CRLF);
 500 }
 501
 502 void quit() {
 503         if (my_strncmp("UIT", (char*)sci_rx_buf+1, 3))
 504                 send_string("013 You can't quit you doofus." CRLF);
 505         else
 506                 unknown_command();
 507 }
 508
 509 int main() {
 510         u8 i;
 511         for (i = 0; i < 11; i++)
 512                 display_buf[i] = ' ';
 513         display_buf[10] = '\0';
 514
 515         changer_output = 0x7f;
 516         _io_ports[M6811_PORTA] = 0xc0; /* display on. talking to serial port */
 517         _io_ports[M6811_DDRA] = 0xfc;
 518         _io_ports[M6811_DDRD] = 0x3e;
 519         _io_ports[M6811_SPCR] = M6811_MSTR | M6811_SPR1;
 520         set_misc_output(0x00);
 521
 522         display_init();
 523         set_msg(" HELLO    ");
 524         delay(1000);
 525
 526         unlock(); /* enable interrupts */
 527
 528         set_msg("  CRUEL   ");
 529
 530         //coinmech_init();
 531         sci_init();
 532         keypad_init();
 533         last_coin_value = 0;
 534         last_door_open = 0;
 535
 536         delay(1000);
 537
 538         set_msg("   WORLD  ");
 539         delay(1000);
 540
 541         chime_start();
 542
 543         send_string("5N4X0RZ R US" CRLF);
 544
 545         last_standalone = is_standalone();
 546         if (last_standalone)
 547                 cur_motor[0] = 0xff;
 548         else
 549                 cur_motor[0] = 0;
 550         send_prompt();
 551
 552         last_switch_input = switch_input;
 553         last_misc_input = misc_input;
 554
 555         while(1) {
 556                 if (cur_motor[0] == 0xff) { /* signal to say redraw screen */
 557                         set_msg("*5N4X0RZ* ");
 558                         cur_motor[0] = 0;
 559                 }
 560
 561                 if (door_open() != last_door_open) {
 562                         last_door_open = door_open();
 563                         send_door_msg(last_door_open);
 564                         chime_start();
 565                         if (is_standalone())
 566                                 set_msg(last_door_open?"DOOR OPEN ":"DOOR CLOSE");
 567                 }
 568
 569                 if (last_standalone != is_standalone()) {
 570                         /* somebody flicked the standalone switch */
 571                         msg_clr();
 572                         send_string(CRLF);
 573                         send_prompt();
 574                         last_standalone = is_standalone();
 575                 }
 576
 577                 if (last_misc_input != misc_input) {
 578                         print_switches(0);
 579                         last_misc_input = misc_input;
 580                 }
 581
 582                 if (last_switch_input != switch_input) {
 583                         print_switches(0);
 584                         last_switch_input = switch_input;
 585                 }
 586
 587                 if (sci_have_packet) {
 588                         send_string(CRLF);
 589                         switch (sci_rx_buf[0]) {
 590                                 case '\0':
 591                                 case '#':
 592                                         send_string(CRLF);
 593                                         break;
 594                                 case 'A':
 595                                         about();
 596                                         break;
 597                                 case 'B':
 598                                         do_chime();
 599                                         break;
 600                                 case 'C':
 601                                         do_silence();
 602                                         break;
 603                                 case 'D':
 604                                         write_to_display();
 605                                         break;
 606                                 case 'E':
 607                                         set_echo();
 608                                         break;
 609                                 case 'G':
 610                                         getrom();
 611                                         break;
 612                                 case 'H':
 613                                         help();
 614                                         break;
 615                                 case 'M':
 616                                         moo();
 617                                         break;
 618                                 case 'P':
 619                                         if (sci_rx_buf[1] == 'I')
 620                                                 ping_pong();
 621                                         else if (sci_rx_buf[1] == 'O')
 622                                                 poke();
 623                                         else if (sci_rx_buf[1] == 'E')
 624                                                 peek();
 625                                         break;
 626                                 case 'J':
 627                                         jump();
 628                                         break;
 629                                 case 'Q':
 630                                         quit();
 631                                         break;
 632                                 case 'S':
 633                                         print_switches(1);
 634                                         break;
 635                                 case 'V':
 636                                         dispense_something();
 637                                         break;
 638                                 case 'W':
 639                                         do_set_password();
 640                                         break;
 641                                 default:
 642                                         // shurg
 643                                         unknown_command();
 644                                         break;
 645                         }
 646                         msg_clr();
 647                         send_prompt();
 648                 }
 649
 650                 keypad_read();
 651                 if (keypad_pressed()) {
 652                         if (is_standalone()) {
 653                                 if (last_key == KEY_RESET) {
 654                                         cur_motor[0] = 0xff;
 655                                 } else {
 656                                         if (cur_motor[0]) {
 657                                                 u8 motor_num;
 658                                                 cur_motor[1] = last_key%10;
 659                                                 display_buf[1] = cur_motor[1]+'0';
 660                                                 set_msg(display_buf);
 661
 662                                                 motor_num = cur_motor[0]%10;
 663                                                 motor_num *= 10;
 664                                                 motor_num += cur_motor[1];
 665                                                 switch (dispense_motor(motor_num)) {
 666                                                         case MOTOR_HOME_FAIL:
 667                                                                 set_msg(" HOME FAIL ");
 668                                                                 break;
 669                                                         case MOTOR_CURRENT_FAIL:
 670                                                                 set_msg(" OVER CRNT ");
 671                                                                 break;
 672                                                         case MOTOR_SUCCESS:
 673                                                                 set_msg("THANK  YOU");
 674                                                                 break;
 675                                                         case MOTOR_NOSLOT:
 676                                                                 set_msg(" NO MOTOR ");
 677                                                                 break;
 678                                                         default:
 679                                                                 set_msg("ERRRRRRRR?");
 680                                                                 break;
 681                                                 }
 682
 683                                                 display_buf[0] = ' ';
 684                                                 display_buf[1] = ' ';
 685                                                 cur_motor[0] = 0xff;
 686                                                 delay(500);
 687                                         } else {
 688                                                 cur_motor[0] = last_key;
 689                                                 display_buf[0] = (last_key%10)+'0';
 690                                                 set_msg(display_buf);
 691                                         }
 692                                 }
 693                         } else
 694                                 send_keypress(last_key);
 695                 }
 696
 697                 /*
 698                 if (coin_value != last_coin_value) {
 699                         send_balance();
 700                         last_coin_value = coin_value;
 701                 }
 702                 */
 703         }
 704 }