X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=src%2Fserver%2Fhandler_coke.c;h=ad5387fdfb35f2420bd7b3f0f7b79bdb70797bb2;hb=4343d1b16536d868dce734fdf3a8debf6f7bf890;hp=f8ed1682786fd255d2d5cb6846ac10b12e42a5d4;hpb=a189b749e46348379d2271eb7c51ca1f7334cbda;p=tpg%2Fopendispense2.git diff --git a/src/server/handler_coke.c b/src/server/handler_coke.c index f8ed168..ad5387f 100644 --- a/src/server/handler_coke.c +++ b/src/server/handler_coke.c @@ -9,6 +9,7 @@ */ #include "common.h" #include +#include #include #include #include @@ -20,6 +21,8 @@ int Coke_InitHandler(); int Coke_CanDispense(int User, int Item); int Coke_DoDispense(int User, int Item); + int WaitForColon(); + int ReadLine(int len, char *output); // === GLOBALS === tHandler gCoke_Handler = { @@ -35,30 +38,65 @@ regex_t gCoke_StatusRegex; // == CODE === int Coke_InitHandler() { - giCoke_SerialFD = open(gsCoke_SerialPort, O_RDWR); - regexc(&gCoke_StatusRegex, "^$", REG_EXTENDED); + printf("connecting to coke machine...\n"); + + giCoke_SerialFD = InitSerial(gsCoke_SerialPort, 9600); + if( giCoke_SerialFD == -1 ) { + fprintf(stderr, "ERROR: Unable to open coke serial port ('%s')\n", gsCoke_SerialPort); + } + + CompileRegex(&gCoke_StatusRegex, "^slot\\s+(\\d)\\s+([^:]+):([a-zA-Z]+)\\s*", REG_EXTENDED); return 0; } int Coke_CanDispense(int User, int Item) { - char tmp[32]; + char tmp[32], *status; regmatch_t matches[4]; + int ret; // Sanity please - if( Item < 0 || Item > 6 ) return -1; + if( Item < 0 || Item > 6 ) return -1; // -EYOURBAD + + write(giCoke_SerialFD, "d7\r\n", 4); + write(giCoke_SerialFD, "d7\r\n", 4); + write(giCoke_SerialFD, "d7\r\n", 4); + + if( WaitForColon() ) { + fprintf(stderr, "Coke machine timed out\n"); + return -2; // -EMYBAD + } // Ask the coke machine - sprintf(tmp, "s%i", Item); - write(giCoke_SerialFD, tmp, 2); - - // Read the response - read(giCoke_SerialFD, tmp, sizeof(tmp)-1); - regexec(&gCoke_StatusRegex, tmp, sizeof(matches)/sizeof(matches[0]), matches); - - printf("s%i response '%s'\n", Item, tmp); + sprintf(tmp, "s%i\r\n", Item); + write(giCoke_SerialFD, tmp, 4); + + WaitForColon(); - return 0; + ret = ReadLine(sizeof(tmp)-1, tmp); + printf("ret = %i, tmp = '%s'\n", ret, tmp); + + if( ret <= 0 ) { + fprintf(stderr, "Coke machine is not being chatty (read = %i)\n", ret); + if( ret == -1 ) { + perror("Coke Machine"); + } + return -1; + } + ret = RunRegex(&gCoke_StatusRegex, tmp, sizeof(matches)/sizeof(matches[0]), matches, "Bad Response"); + if( ret ) { + return -1; + } + + tmp[ matches[3].rm_eo ] = '\0'; + status = &tmp[ matches[3].rm_so ]; + + printf("Machine responded slot status '%s'\n", status); + + if( strcmp(status, "full") == 0 ) + return 0; + + return 1; } /** @@ -66,22 +104,96 @@ int Coke_CanDispense(int User, int Item) */ int Coke_DoDispense(int User, int Item) { - char tmp[32]; + char tmp[32], *status; + regmatch_t matches[4]; // Sanity please if( Item < 0 || Item > 6 ) return -1; + WaitForColon(); + // Dispense - sprintf(tmp, "d%i", Item); - write(giCoke_SerialFD, tmp, 2); + sprintf(tmp, "d%i\r\n", Item); + write(giCoke_SerialFD, tmp, 4); + + WaitForColon(); // Get status - read(giCoke_SerialFD, tmp, sizeof(tmp)-1); - regexec(&gCoke_StatusRegex, tmp, sizeof(matches)/sizeof(matches[0]), matches); + ReadLine(sizeof(tmp)-1, tmp); + + tmp[ matches[3].rm_eo ] = '\0'; + status = &tmp[ matches[3].rm_so ]; + + printf("Machine responded slot status '%s'\n", status); + + return 0; +} + +char ReadChar() +{ + fd_set readfs; + char ch = 0; + int ret; + struct timeval timeout; + + timeout.tv_sec = 5; // 5 second timeout + timeout.tv_usec = 0; + + FD_ZERO(&readfs); + FD_SET(giCoke_SerialFD, &readfs); - printf("d%i response '%s'\n", Item, tmp); + ret = select(giCoke_SerialFD+1, &readfs, NULL, NULL, &timeout); + if( ret == 0 ) return 0; // Timeout + if( ret != 1 ) { + printf("readchar return %i\n", ret); + return 0; + } + + ret = read(giCoke_SerialFD, &ch, 1); + if( ret != 1 ) { + printf("ret = %i\n", ret); + return 0; + } + + return ch; +} +int WaitForColon() +{ + fd_set readfs; + char ch = 0; + + FD_SET(giCoke_SerialFD, &readfs); + + while( (ch = ReadChar()) != ':' && ch != 0); + + if( ch == 0 ) return -1; // Timeout + return 0; } +int ReadLine(int len, char *output) +{ + char ch; + int i = 0; + + for(;;) + { + ch = ReadChar(); + + + if( i < len ) + output[i++] = ch; + + if( ch == '\0' ) { + return -1; + } + if( ch == '\n' || ch == '\r' ) { + if( i < len ) + output[--i] = '\0'; + return i; + } + } +} +