X-Git-Url: https://git.ucc.asn.au/?p=tpg%2Fopendispense2.git;a=blobdiff_plain;f=src%2Fserver%2Fhandler_coke.c;h=12e24315b98c442ea0d441dc9f355ebc7d1d6c33;hp=9ec2576aa5f458614721d7fa504e7d2045a5dcf8;hb=24654ef0078320798912a273508e37f9ce921ba7;hpb=4479b79dd78867af8d7cd236df73ded9bf5cc07a diff --git a/src/server/handler_coke.c b/src/server/handler_coke.c index 9ec2576..12e2431 100644 --- a/src/server/handler_coke.c +++ b/src/server/handler_coke.c @@ -23,6 +23,12 @@ #define READ_TIMEOUT 2 // 2 seconds for ReadChar #define TRACE_COKE 1 +#if TRACE_COKE +# define TRACE(v...) do{printf("%s: ",__func__);printf(v);}while(0) +#else +# define TRACE(...) +#endif + // === IMPORTS === // === PROTOTYPES === @@ -51,6 +57,8 @@ pthread_mutex_t gCoke_Mutex = PTHREAD_MUTEX_INITIALIZER; // == CODE === int Coke_InitHandler() { + CompileRegex(&gCoke_StatusRegex, "^slot\\s+([0-9]+)\\s+([^:]+):([a-zA-Z]+)\\s*", REG_EXTENDED); + printf("connecting to coke machine...\n"); giCoke_SerialFD = InitSerial(gsCoke_SerialPort, 9600); @@ -58,6 +66,9 @@ int Coke_InitHandler() fprintf(stderr, "ERROR: Unable to open coke serial port ('%s')\n", gsCoke_SerialPort); } else { + int i; + for( i = 0; i < 7; i ++ ) + gaCoke_CachedStatus[i] = -1; // Reset the slot names. // - Dunno why this is needed, but the machine plays silly // sometimes. @@ -82,7 +93,6 @@ int Coke_InitHandler() AddPeriodicFunction(Coke_int_UpdateSlotStatuses); - CompileRegex(&gCoke_StatusRegex, "^slot\\s+([0-9]+)\\s+([^:]+):([a-zA-Z]+)\\s*", REG_EXTENDED); return 0; } @@ -102,9 +112,7 @@ int Coke_int_GetSlotStatus(char *Buffer, int Slot) Buffer[ matches[3].rm_eo ] = '\0'; status = &Buffer[ matches[3].rm_so ]; - #if TRACE_COKE - printf("Coke_CanDispense: Machine responded slot status '%s'\n", status); - #endif + TRACE("Machine responded slot %i status '%s'\n", Slot, status); if( strcmp(status, "full") == 0 ) { gaCoke_CachedStatus[Slot] = 0; // 0: Avaliiable @@ -129,23 +137,37 @@ void Coke_int_UpdateSlotStatuses(void) pthread_mutex_lock(&gCoke_Mutex); - WaitForColon(); + while( ReadLine(sizeof tmp, tmp) >= 0 ) ; + TRACE("send d7\n"); Writef("d7\r\n"); // Update slot statuses if( WaitForColon() ) goto ret; - Writef("s\n"); - ReadLine(sizeof tmp, tmp); // Read back what we just said + TRACE("send s\n"); + Writef("s\r\n"); + do { + i = ReadLine(sizeof tmp, tmp); // Read back what we just said + if( i == -1 ) { + TRACE("Eat read failed"); + goto ret; + } + } while(tmp[0] != ':' && tmp[1] != 's'); for( i = 0; i <= 6; i ++ ) { len = ReadLine(sizeof tmp, tmp); if( len == -1 ) { - #if TRACE_COKE - printf("Coke_int_UpdateSlotStatuses: Read failed on slot %i\n", i); - #endif + TRACE("Read failed on slot %i\n", i); goto ret; // I give up :( } + TRACE("tmp = '%s'\n", tmp); Coke_int_GetSlotStatus(tmp, i); } + // Eat blank line + len = ReadLine(sizeof tmp, tmp); + if( len == -1 ) { + TRACE("Read failed on blank line\n"); + } + + TRACE("Updated\n"); ret: pthread_mutex_unlock(&gCoke_Mutex); @@ -181,10 +203,9 @@ int Coke_DoDispense(int UNUSED(User), int Item) // LOCK pthread_mutex_lock(&gCoke_Mutex); - #if TRACE_COKE - printf("Coke_DoDispense: flushing input\n"); - #endif + TRACE("flushing input\n"); + // Wait for prompt ret = 0; while( WaitForColon() && ret < 3 ) @@ -192,16 +213,18 @@ int Coke_DoDispense(int UNUSED(User), int Item) // Flush the input buffer char tmpbuf[512]; read(giCoke_SerialFD, tmpbuf, sizeof(tmpbuf)); - #if TRACE_COKE - printf("Coke_DoDispense: sending 'd7'\n"); - #endif + TRACE("sending 'd7'\n"); Writef("d7\r\n"); ret ++; } + if( ret == 3 ) + { + TRACE("timed out\n"); + pthread_mutex_unlock(&gCoke_Mutex); + return -1; + } - #if TRACE_COKE - printf("Coke_DoDispense: sending 'd%i'\n", Item); - #endif + TRACE("sending 'd%i'\n", Item); // Dispense Writef("d%i\r\n", Item); @@ -212,16 +235,12 @@ int Coke_DoDispense(int UNUSED(User), int Item) pthread_mutex_unlock(&gCoke_Mutex); return -1; } - #if TRACE_COKE - printf("Coke_DoDispense: read %i '%s'\n", ret, tmp); - #endif + TRACE("read %i '%s'\n", ret, tmp); } while( ret == 0 || tmp[0] == ':' || tmp[0] == 'd' ); WaitForColon(); // Eat up rest of response - #if TRACE_COKE - printf("Coke_DoDispense: done\n"); - #endif + TRACE("done\n"); // TODO: Regex instead? if( strcmp(tmp, "ok") == 0 ) { @@ -235,19 +254,25 @@ int Coke_DoDispense(int UNUSED(User), int Item) ret = -1; } - #if TRACE_COKE - printf("Coke_DoDispense: Updating slot status\n"); - #endif + TRACE("Updating slot status\n"); + // Update status + WaitForColon(); Writef("s%i\r\n", Item); len = ReadLine(sizeof tmp, tmp); if(len == -1) gaCoke_CachedStatus[Item] = -1; Coke_int_GetSlotStatus(tmp, Item); + { + char buf[512]; + read(giCoke_SerialFD, buf, 512); // Flush + } // Release and return pthread_mutex_unlock(&gCoke_Mutex); - return ret; + //return ret; + // HACK!!! + return 0; } char ReadChar() @@ -266,13 +291,13 @@ char ReadChar() ret = select(giCoke_SerialFD+1, &readfs, NULL, NULL, &timeout); if( ret == 0 ) return 0; // Timeout if( ret != 1 ) { - printf("readchar return %i\n", ret); + printf("ReadChar: select return %i\n", ret); return 0; } ret = read(giCoke_SerialFD, &ch, 1); if( ret != 1 ) { - printf("ret = %i\n", ret); + printf("ReadChar: ret != 1 (%i)\n", ret); return 0; } @@ -339,8 +364,6 @@ int ReadLine(int len, char *output) } } - //printf("ReadLine: output=%s\n", output); - if( !ch ) return -1; return i; }