* and snacks.
*/
+#define VERSION_STRING "X 20040625"
+
#include "display_basic.h"
#include "keypad.h"
#include "chime.h"
#include "coinmech.h"
#include "motors.h"
-#include "comm.h"
+#include "sci.h"
#include "vend.h"
+#include "xmodem.h"
+#include "mic.h"
+
+u8 last_standalone;
+u8 last_switch_input;
+u8 last_misc_input;
+u16 last_coin_value;
+bool last_door_open;
+char display_buf[11];
+/* cur_motor[0] is 0 for nothing, or 1..10, or 0xff to say redraw.
+ * cur_motor[1] is 0..9 and only meaningful is cur_motor[0] != 0. */
+u8 cur_motor[2];
+
+bool check_standalone() {
+ if (is_standalone()) {
+ send_string("011 In standalone mode. Function disabled." CRLF);
+ return 1;
+ }
+ return 0;
+}
+
+bool check_badpoke() {
+ if (cant_poke()) {
+ send_string("099 Can't poke without flipping DIP SW 3." CRLF);
+ return 1;
+ }
+ return 0;
+}
+
+void unknown_command() {
+ send_string("012 Unknown command. Type HELP for help." CRLF);
+}
-void motor_reply(char* slotptr, u8 code) {
+void motor_reply(u8 code) {
/* returns a message of the form MXYY - X is return code, YY is motor */
- wait_for_tx_free();
- tx_buffer[0] = 'M';
- tx_buffer[1] = code + '0';
- tx_buffer[2] = *slotptr;
- tx_buffer[3] = *(slotptr+1);
- tx_buffer[4] = '\n';
- tx_buffer[5] = 0;
- send_packet();
+ switch (code) {
+ case MOTOR_SUCCESS:
+ send_string("100 Vend successful." CRLF);
+ break;
+ case MOTOR_NOSLOT:
+ send_string("151 No motor there." CRLF);
+ break;
+ case MOTOR_CURRENT_FAIL:
+ send_string("152 Over current." CRLF);
+ break;
+ case MOTOR_HOME_FAIL:
+ send_string("153 Home sensors failing." CRLF);
+ break;
+ default:
+ send_string("159 Unknown motor error." CRLF);
+ }
}
void dispense_something() {
- /* process a message VXX in msg_buf where XX is motor number */
+ /* process a message VXX in sci_rx_buf where XX is motor number */
u8 slot;
- if ((msg_buf[1] < '0') || (msg_buf[1] > '9') ||
- (msg_buf[2] < '0') || (msg_buf[2] > '9')) {
- msg_buf[1] = msg_buf[2] = '0';
- motor_reply((char*)&msg_buf[1], MOTOR_NOSLOT);
+ if (check_standalone()) return;
+ if (must_verify() && !mic_verify((void*)sci_rx_buf)) {
+ send_string("019 Message verification failed." CRLF);
+ return;
+ }
+
+ if (my_strncmp("ALL", (char*)sci_rx_buf+1, 3)) {
+ char motor[3];
+ motor[2] = '\0';
+ send_string("102 Vend all motors starting." CRLF);
+ for (motor[0] = '0'; motor[0] <= '9'; motor[0]++) {
+ for (motor[1] = '0'; motor[1] <= '9'; motor[1]++) {
+ if (motor[1] == '5') continue; /* there is now row 5 */
+ send_string("101 Vending ");
+ send_string(motor);
+ send_string(CRLF);
+ motor_reply(dispense_motor((motor[0]-'0')*10+(motor[1]-'0')));
+ }
+ }
+ send_string("102 Vend all motors complete." CRLF);
+ return;
+ }
+
+ if ((sci_rx_buf[1] < '0') || (sci_rx_buf[1] > '9') ||
+ (sci_rx_buf[2] < '0') || (sci_rx_buf[2] > '9')) {
+ sci_rx_buf[1] = sci_rx_buf[2] = '0';
+ motor_reply(MOTOR_NOSLOT);
return;
}
- slot = (msg_buf[1] - '0') * 10;
- slot += msg_buf[2] - '0';
+ slot = (sci_rx_buf[1] - '0') * 10;
+ slot += sci_rx_buf[2] - '0';
- motor_reply((char*)&msg_buf[1], dispense_motor(slot));
+ motor_reply(dispense_motor(slot));
}
void write_to_display() {
- /* process a message in the form DXXXXXXXXXXX to send to display */
+ /* process a message in the form DXXXXXXXXXX to send to display */
u8 i;
- char buf[10];
+ char buf[11];
+
+ if (check_standalone()) return;
+
for (i = 0; i < 10; i++)
- if (msg_buf[i+1])
- buf[i] = msg_buf[i+1];
+ if (sci_rx_buf[i+1])
+ buf[i] = sci_rx_buf[i+1];
else
break;
for (; i < 10; i++) /* pad the rest out with spaces */
buf[i] = ' ';
+ buf[i] = '\0';
set_msg(buf);
- send_ack();
+ send_string("300 Written." CRLF);
}
void send_balance() {
- wait_for_tx_free();
- tx_buffer[0] = 'C';
- tx_buffer[1] = have_change?'0':'1';
- tx_buffer[2] = (coin_value/10000)%10;
- tx_buffer[3] = (coin_value/1000)%10;
- tx_buffer[4] = (coin_value/100)%10;
- tx_buffer[5] = (coin_value/10)%10;
- tx_buffer[6] = coin_value%10;
- tx_buffer[7] = '\n';
- tx_buffer[8] = 0;
- send_packet();
+ sci_tx_buf[0] = 'C';
+ sci_tx_buf[1] = have_change?'0':'1';
+ sci_tx_buf[2] = (coin_value/10000)%10;
+ sci_tx_buf[3] = (coin_value/1000)%10;
+ sci_tx_buf[4] = (coin_value/100)%10;
+ sci_tx_buf[5] = (coin_value/10)%10;
+ sci_tx_buf[6] = coin_value%10;
+ sci_tx_buf[8] = 0;
+ send_buffer(1);
}
void give_change() {
u16 cost;
- if ((msg_buf[1] < '0') || (msg_buf[1] > '9') ||
- (msg_buf[2] < '0') || (msg_buf[2] > '9') ||
- (msg_buf[3] < '0') || (msg_buf[3] > '9') ||
- (msg_buf[4] < '0') || (msg_buf[4] > '9') ||
- (msg_buf[5] < '0') || (msg_buf[5] > '9')) {
- send_nack();
+ if ((sci_rx_buf[1] < '0') || (sci_rx_buf[1] > '9') ||
+ (sci_rx_buf[2] < '0') || (sci_rx_buf[2] > '9') ||
+ (sci_rx_buf[3] < '0') || (sci_rx_buf[3] > '9') ||
+ (sci_rx_buf[4] < '0') || (sci_rx_buf[4] > '9') ||
+ (sci_rx_buf[5] < '0') || (sci_rx_buf[5] > '9')) {
+ //send_nack();
}
- cost = msg_buf[1] - '0';
- cost *= 10; cost = msg_buf[2] - '0';
- cost *= 10; cost = msg_buf[3] - '0';
- cost *= 10; cost = msg_buf[4] - '0';
- cost *= 10; cost = msg_buf[5] - '0';
+ cost = sci_rx_buf[1] - '0';
+ cost *= 10; cost = sci_rx_buf[2] - '0';
+ cost *= 10; cost = sci_rx_buf[3] - '0';
+ cost *= 10; cost = sci_rx_buf[4] - '0';
+ cost *= 10; cost = sci_rx_buf[5] - '0';
coin_cost(cost);
- send_ack();
+ //send_ack();
}
void send_keypress(u8 key) {
/* send a packet of the form KX with X being the key, or R for reset */
- wait_for_tx_free();
- tx_buffer[0] = 'K';
- if (key == KEY_RESET)
- tx_buffer[1] = 'R';
- else
- tx_buffer[1] = (key%10)+'0';
- tx_buffer[2] = '\n';
- tx_buffer[3] = 0;
- send_packet();
+ if (is_standalone()) return;
+
+ sci_tx_buf[0] = '2';
+ if (key == KEY_RESET) {
+ sci_tx_buf[1] = '1';
+ sci_tx_buf[2] = '1';
+ } else {
+ sci_tx_buf[1] = '0';
+ sci_tx_buf[2] = (key%10)+'0';
+ }
+ sci_tx_buf[3] = '\0';
+ send_buffer(0);
+ send_string(" key." CRLF);
}
void send_door_msg(bool open) {
- wait_for_tx_free();
- tx_buffer[0] = 'D';
- tx_buffer[1] = open?'1':'0';
- tx_buffer[2] = '\n';
- tx_buffer[3] = 0;
- send_packet();
+ if (is_standalone()) return;
+ sci_tx_buf[0] = '4';
+ sci_tx_buf[1] = '0';
+ sci_tx_buf[2] = open?'1':'0';
+ send_buffer(0);
+ if (open)
+ send_string(" door open." CRLF);
+ else
+ send_string(" door closed." CRLF);
}
void do_chime() {
- chime_start();
- send_ack();
+ if (check_standalone()) return;
+ if (sci_rx_buf[1] == '\0')
+ chime_start();
+ else if (sci_rx_buf[1] == 'S') { /* synchronous beep */
+ if (sci_rx_buf[2] == '\0')
+ chime_start();
+ else if (sci_rx_buf[3] != '\0' && sci_rx_buf[4] == '\0')
+ chime_for(hex2u8(sci_rx_buf[2], sci_rx_buf[3]));
+ else {
+ send_string("510 Unknown chime duration." CRLF);
+ return;
+ }
+ while (chime_count); /* spin */
+ send_string("500 Chimed." CRLF);
+ return;
+ } else if (sci_rx_buf[2] != '\0' && sci_rx_buf[3] == '\0')
+ chime_for(hex2u8(sci_rx_buf[1], sci_rx_buf[2]));
+ else {
+ send_string("510 Unknown chime duration." CRLF);
+ return;
+ }
+ send_string("500 Chime started." CRLF);
+ return;
+}
+
+void do_silence() {
+ if (check_standalone()) return;
+ if (sci_rx_buf[1] == '\0')
+ unchime_start();
+ else if (sci_rx_buf[1] == 'S') { /* synchronous beep */
+ if (sci_rx_buf[2] == '\0')
+ unchime_start();
+ else if (sci_rx_buf[3] != '\0' && sci_rx_buf[4] == '\0')
+ unchime_for(hex2u8(sci_rx_buf[2], sci_rx_buf[3]));
+ else {
+ send_string("511 Unknown silence duration." CRLF);
+ return;
+ }
+ while (unchime_count); /* spin */
+ send_string("501 Silenced." CRLF);
+ return;
+ } else if (sci_rx_buf[2] != '\0' && sci_rx_buf[3] == '\0')
+ unchime_for(hex2u8(sci_rx_buf[1], sci_rx_buf[2]));
+ else {
+ send_string("511 Unknown silence duration." CRLF);
+ return;
+ }
+ send_string("501 Silence started." CRLF);
+ return;
+}
+
+void print_switches(u8 prompted) {
+ if (prompted)
+ send_string("600 ");
+ else
+ send_string("610 ");
+ send_string(u82hex(misc_input));
+ send_string(" ");
+ send_string(u82hex(switch_input));
+ send_string(CRLF);
}
void ping_pong() {
/* make sure it's really a ping */
- if (msg_buf[1] != 'I' ||
- msg_buf[2] != 'N' ||
- msg_buf[3] != 'G') {
- send_nack();
+ if (!my_strncmp("ING", (char*)sci_rx_buf+1, 3)) {
+ unknown_command();
return;
}
/* respond with ack & pong */
- wait_for_tx_free();
- tx_buffer[0] = 'P';
- tx_buffer[1] = 'O';
- tx_buffer[2] = 'N';
- tx_buffer[3] = 'G';
- tx_buffer[4] = '\n';
- tx_buffer[5] = 0;
- send_packet();
+ send_string("000 PONG!" CRLF);
}
-u16 last_coin_value;
-bool last_door_open;
-char display_buf[11];
-/* cur_motor[0] is 0 for nothing, or 1..10, or 0xff to say redraw.
- * cur_motor[1] is 0..9 and only meaningful is cur_motor[0] != 0. */
-u8 cur_motor[2];
+u16 hex2addr(char* addrptr) {
+ u16 v;
+ v = hex2u8(addrptr[0], addrptr[1]) << 8;
+ v |= hex2u8(addrptr[2], addrptr[3]);
+ return v;
+}
+
+void peek() {
+ if (!my_strncmp("EEK", (char*)sci_rx_buf+1, 3)) {
+ unknown_command();
+ return;
+ }
+ if (check_badpoke()) return;
+ if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
+ ishex(sci_rx_buf[7]) && sci_rx_buf[8] == '\0') {
+ u16 v = hex2addr((char*)(sci_rx_buf+4));
+ v = *((u8*)v);
+ send_string("090 ");
+ send_string(u82hex(v));
+ send_string(CRLF);
+ return;
+ }
+ send_string("091 Invalid location given." CRLF);
+}
+
+void poke() {
+ if (!my_strncmp("OKE", (char*)sci_rx_buf+1, 3)) {
+ unknown_command();
+ return;
+ }
+ if (check_badpoke()) return;
+ if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
+ ishex(sci_rx_buf[7]) && ishex(sci_rx_buf[8]) && ishex(sci_rx_buf[9])
+ && sci_rx_buf[10] == '\0') {
+ u16 v;
+ v = hex2addr((char*)(sci_rx_buf+4));
+ *(u8*)v = hex2u8(sci_rx_buf[8], sci_rx_buf[9]);
+ send_string("080 Written." CRLF);
+ return;
+ }
+ send_string("081 Invalid location or byte given." CRLF);
+}
+
+void jump() {
+ if (!my_strncmp("UMP", (char*)sci_rx_buf+1, 3)) {
+ unknown_command();
+ return;
+ }
+ if (check_badpoke()) return;
+ if (ishex(sci_rx_buf[4]) && ishex(sci_rx_buf[5]) && ishex(sci_rx_buf[6]) &&
+ ishex(sci_rx_buf[7]) && sci_rx_buf[8] == '\0') {
+ u16 v = hex2addr((char*)(sci_rx_buf+4));
+ send_string("070 Jumping now." CRLF);
+ asm volatile ("jsr %0" : : "m"(*(u16*)v) : "d");
+ send_string("071 And back." CRLF);
+ return;
+ }
+ send_string("079 Invalid location given." CRLF);
+}
+
+void do_set_password() {
+ u8 i;
+ bool good = 1;
+ if (check_badpoke()) return;
+ for (i=1; i < 17; i++) {
+ if (sci_rx_buf[i] == '\0') {
+ good = 0;
+ break;
+ }
+ }
+ if (good && sci_rx_buf[17] != '\0') good = 0;
+ if (!good) {
+ send_string("061 Password must be exactly 16 characters." CRLF);
+ return;
+ }
+
+ mic_set_secret((char*)(sci_rx_buf+1));
+ send_string("060 Password has been set." CRLF);
+}
+
+void send_prompt() {
+ if (must_verify()) {
+ send_string(u82hex(mic_challenge >> 8));
+ send_string(u82hex(mic_challenge & 0xff));
+ }
+ send_string(is_standalone()?"% ":"# ");
+}
+
+void about() {
+ if (!my_strncmp("BOUT", (char*)sci_rx_buf+1, 4)) {
+ unknown_command();
+ return;
+ }
+ send_string(
+ "-----------------------------------------------------------------" CRLF
+ "-----------------------------------------------------------------" CRLF
+ " Revision " VERSION_STRING CRLF
+ "" CRLF
+ " This snack machine was brought to you by " CRLF
+ " Bernard Blackham" CRLF
+ " Mark Tearle" CRLF
+ " Harry McNally" CRLF
+ " Michal Gornisiewicz" CRLF
+ " and others." CRLF
+ "" CRLF
+ " Another UCC project in action. http://www.ucc.asn.au/" CRLF
+ );
+}
+
+void set_echo() {
+ if (my_strncmp("CHO ON", (char*)sci_rx_buf+1, 6))
+ sci_echo = 1;
+ else if (my_strncmp("CHO OFF", (char*)sci_rx_buf+1, 7))
+ sci_echo = 0;
+ else
+ unknown_command();
+}
+
+void moo() {
+ if (!my_strncmp("OO", (char*)sci_rx_buf+1, 2)) {
+ unknown_command();
+ return;
+ }
+ send_string(
+" ____________" CRLF
+" |__________|" CRLF
+" / /\\" CRLF
+" / U C C / \\" CRLF
+" /___________/___/|" CRLF
+" | | |" CRLF
+" | ==\\ /== | |" CRLF
+" | O O | \\ \\ |" CRLF
+" | < | \\ \\|" CRLF
+" /| | \\ \\" CRLF
+" / | \\_____/ | / /" CRLF
+" / /| | / /|" CRLF
+"/||\\| | /||\\/" CRLF
+" -------------| " CRLF
+" | | | | " CRLF
+" <__/ \\__>" CRLF
+"" CRLF
+" ... Where's the cheese?" CRLF
+ );
+}
+
+void help() {
+ send_string(
+ "Valid commands are:" CRLF
+ " ABOUT ROM information" CRLF
+ " B[S][nn] beep [synchronously] for a duration nn (optional)" CRLF
+ " C[S][nn] silence [synchronously] for a duration nn (optional)" CRLF
+ " Dxxxxxxxxxx show a message on the display" CRLF
+ " ECHO {ON|OFF} turn echo on or off" CRLF
+ " GETROM download the ROM source code using xmodem" CRLF
+ " H[...] this help screen" CRLF
+ "*JUMPxxxx jumps to a subroutine at location xxxx" CRLF
+ "*PEEKxxxx returns the value of the byte at location xxxx" CRLF
+ "*POKExxxxyy sets the value of location xxxx to yy" CRLF
+ " PING pongs" CRLF
+ " S[...] query all internal switch states" CRLF
+ "+Vnn vend an item" CRLF
+ "+VALL vend all items" CRLF
+ "*Wxxxxxxxxxxxx set a new password for authenticated vends. xxx=16 chars" CRLF
+ " password will be converted to uppercase" CRLF
+ "" CRLF
+ "Very few functions are available when the machine is in standalone " CRLF
+ "mode (DIP SW 1 is set)" CRLF
+ "+ denotes that this item requires authentication if DIP SW 2 is set" CRLF
+ "* denotes that DIP SW 3 must be set to use these" CRLF
+ "Commands starting with # are ignored (comments)" CRLF
+ );
+}
+
+extern const char _rom_src_data[];
+extern const u16 _rom_src_len;
+void getrom() {
+ if (!my_strncmp("ETROM", (char*)sci_rx_buf+1, 5)) {
+ unknown_command();
+ return;
+ }
+ char s[4];
+
+ u16 rom_addr;
+ rom_addr = (u16)(&_rom_src_data);
+
+ send_string("Writing to serial port (maybe). Size is 0x");
+ send_string(u82hex(_rom_src_len >> 8));
+ send_string(u82hex(_rom_src_len & 0xff));
+ send_string("@0x");
+ send_string(u82hex(rom_addr >> 8));
+ send_string(u82hex(rom_addr & 0xff));
+ send_string(" with signature ");
+ s[0] = _rom_src_data[0];
+ s[1] = _rom_src_data[1];
+ s[2] = _rom_src_data[2];
+ s[3] = '\0';
+ send_string(s);
+ send_string(CRLF " Type YES to download rom.tar.bz2 via XMODEM: ");
+ msg_clr();
+ while (!sci_have_packet); /* spin */
+ if (!my_strncmp("YES", (char*)sci_rx_buf, 3)) {
+ send_string(CRLF "Transfer cancelled." CRLF);
+ return;
+ }
+
+ sci_init();
+ sci_doing_xmodem = 1;
+ if (!xmodem_init_xfer()) {
+ sci_doing_xmodem = 0;
+ send_string("XMODEM init failed. Nobody's listening :(" CRLF);
+ return;
+ }
+ char *p = (char*)_rom_src_data;
+ char *end = (char*)_rom_src_data+_rom_src_len;
+ bool aborted = 0;
+ while (1) {
+ if (p + 128 > end) {
+ /* send partial packet */
+ if (!xmodem_send_packet((char*)p, end-p)) aborted = 1;
+ break;
+ } if ((u16)p == 0xb600) {
+ /* we have an eeprom here. skip it. */
+ p += 0x0200;
+ continue;
+ } else if (!xmodem_send_packet((char*)p, 128)) {
+ aborted = 1;
+ break;
+ }
+ p += 128;
+ }
+
+ xmodem_finish_xfer();
+ sci_doing_xmodem = 0;
+ if (aborted)
+ send_string(CRLF "Transfer aborted." CRLF);
+ else
+ send_string(CRLF "Transfer complete." CRLF);
+}
+
+void quit() {
+ if (my_strncmp("UIT", (char*)sci_rx_buf+1, 3))
+ send_string("013 You can't quit you doofus." CRLF);
+ else
+ unknown_command();
+}
int main() {
u8 i;
_io_ports[M6811_PORTA] = 0xc0; /* display on. talking to serial port */
_io_ports[M6811_DDRA] = 0xfc;
_io_ports[M6811_DDRD] = 0x3e;
- _io_ports[M6811_SPCR] = 0x12;
+ _io_ports[M6811_SPCR] = M6811_MSTR | M6811_SPR1;
set_misc_output(0x00);
-
+
display_init();
set_msg(" HELLO ");
+ delay(1000);
unlock(); /* enable interrupts */
- comm_init();
- coinmech_init();
+ set_msg(" CRUEL ");
+
+ //coinmech_init();
+ sci_init();
keypad_init();
last_coin_value = 0;
last_door_open = 0;
delay(1000);
- set_msg(" CRUEL ");
-
- delay(1000);
-
set_msg(" WORLD ");
delay(1000);
chime_start();
- cur_motor[0] = 0xff;
+ send_string("5N4X0RZ R US" CRLF);
+
+ last_standalone = is_standalone();
+ if (last_standalone)
+ cur_motor[0] = 0xff;
+ else
+ cur_motor[0] = 0;
+ send_prompt();
+
+ last_switch_input = switch_input;
+ last_misc_input = misc_input;
+
while(1) {
if (cur_motor[0] == 0xff) { /* signal to say redraw screen */
set_msg("*5N4X0RZ* ");
last_door_open = door_open();
send_door_msg(last_door_open);
chime_start();
- if (last_door_open) {
- set_msg("DOOR OPEND");
- } else {
- set_msg("DOOR CLOSE");
- }
+ if (is_standalone())
+ set_msg(last_door_open?"DOOR OPEN ":"DOOR CLOSE");
}
- /*
- if (rx_queue_state) {
- switch (msg_buf[0]) {
- case 'V':
- dispense_something();
+ if (last_standalone != is_standalone()) {
+ /* somebody flicked the standalone switch */
+ msg_clr();
+ send_string(CRLF);
+ send_prompt();
+ last_standalone = is_standalone();
+ }
+
+ if (last_misc_input != misc_input) {
+ print_switches(0);
+ last_misc_input = misc_input;
+ }
+
+ if (last_switch_input != switch_input) {
+ print_switches(0);
+ last_switch_input = switch_input;
+ }
+
+ if (sci_have_packet) {
+ send_string(CRLF);
+ switch (sci_rx_buf[0]) {
+ case '\0':
+ case '#':
+ send_string(CRLF);
break;
- case 'D':
- write_to_display();
+ case 'A':
+ about();
break;
case 'B':
do_chime();
break;
- case 'U':
- send_balance();
+ case 'C':
+ do_silence();
+ break;
+ case 'D':
+ write_to_display();
+ break;
+ case 'E':
+ set_echo();
break;
case 'G':
- give_change();
+ getrom();
+ break;
+ case 'H':
+ help();
+ break;
+ case 'M':
+ moo();
break;
case 'P':
- ping_pong();
+ if (sci_rx_buf[1] == 'I')
+ ping_pong();
+ else if (sci_rx_buf[1] == 'O')
+ poke();
+ else if (sci_rx_buf[1] == 'E')
+ peek();
+ break;
+ case 'J':
+ jump();
+ break;
+ case 'Q':
+ quit();
+ break;
+ case 'S':
+ print_switches(1);
+ break;
+ case 'V':
+ dispense_something();
+ break;
+ case 'W':
+ do_set_password();
break;
default:
// shurg
- send_nack();
+ unknown_command();
break;
}
msg_clr();
+ send_prompt();
}
- */
keypad_read();
if (keypad_pressed()) {
- if (last_key == KEY_RESET) {
- cur_motor[0] = 0xff;
- } else {
- if (cur_motor[0]) {
- u8 motor_num;
- cur_motor[1] = last_key%10;
- display_buf[1] = cur_motor[1]+'0';
- set_msg(display_buf);
-
- motor_num = cur_motor[0]%10;
- motor_num *= 10;
- motor_num += cur_motor[1];
- dispense_motor(motor_num);
-
- set_msg("THANK YOU");
- display_buf[0] = ' ';
- display_buf[1] = ' ';
+ if (is_standalone()) {
+ if (last_key == KEY_RESET) {
cur_motor[0] = 0xff;
- delay(500);
} else {
- cur_motor[0] = last_key;
- display_buf[0] = (last_key%10)+'0';
- set_msg(display_buf);
+ if (cur_motor[0]) {
+ u8 motor_num;
+ cur_motor[1] = last_key%10;
+ display_buf[1] = cur_motor[1]+'0';
+ set_msg(display_buf);
+
+ motor_num = cur_motor[0]%10;
+ motor_num *= 10;
+ motor_num += cur_motor[1];
+ switch (dispense_motor(motor_num)) {
+ case MOTOR_HOME_FAIL:
+ set_msg(" HOME FAIL ");
+ break;
+ case MOTOR_CURRENT_FAIL:
+ set_msg(" OVER CRNT ");
+ break;
+ case MOTOR_SUCCESS:
+ set_msg("THANK YOU");
+ break;
+ case MOTOR_NOSLOT:
+ set_msg(" NO MOTOR ");
+ break;
+ default:
+ set_msg("ERRRRRRRR?");
+ break;
+ }
+
+ display_buf[0] = ' ';
+ display_buf[1] = ' ';
+ cur_motor[0] = 0xff;
+ delay(500);
+ } else {
+ cur_motor[0] = last_key;
+ display_buf[0] = (last_key%10)+'0';
+ set_msg(display_buf);
+ }
}
- }
- send_keypress(last_key);
+ } else
+ send_keypress(last_key);
}
/*