#include <sys/stat.h>
#include <fcntl.h>
#include <regex.h>
+#include <stdarg.h>
#define READ_TIMEOUT 2 // 2 seconds for ReadChar
#define TRACE_COKE 1
int Coke_InitHandler();
int Coke_CanDispense(int User, int Item);
int Coke_DoDispense(int User, int Item);
+ int Writef(const char *Format, ...);
int WaitForColon();
int ReadLine(int len, char *output);
if( giCoke_SerialFD == -1 ) {
fprintf(stderr, "ERROR: Unable to open coke serial port ('%s')\n", gsCoke_SerialPort);
}
+ else {
+ // Reset the slot names.
+ // - Dunno why this is needed, but the machine plays silly
+ // sometimes.
+ Writef("n0 Slot0\n");
+ WaitForColon();
+ Writef("n1 Slot1\n");
+ WaitForColon();
+ Writef("n2 Slot2\n");
+ WaitForColon();
+ Writef("n3 Slot3\n");
+ WaitForColon();
+ Writef("n4 Slot4\n");
+ WaitForColon();
+ Writef("n5 Slot5\n");
+ WaitForColon();
+ Writef("n6 Coke\n");
+ }
CompileRegex(&gCoke_StatusRegex, "^slot\\s+([0-9]+)\\s+([^:]+):([a-zA-Z]+)\\s*", REG_EXTENDED);
return 0;
#if TRACE_COKE
printf("Coke_CanDispense: sending 'd7'\n");
#endif
- write(giCoke_SerialFD, "d7\r\n", 4);
+ Writef("d7\r\n");
ret ++;
}
-
+ // Check for a timeout error
if( !(ret < 3) ) {
fprintf(stderr, "Coke machine timed out\n");
return -2; // -EMYBAD
}
+
+ // You need to do a 'd7' before reading the status
+ // - Otherwise it sometimes reports a full slot as empty
+ // [TPG] (2011-02-19)
+ if( ret == 0 )
+ {
+ Writef("d7\r\n");
+ WaitForColon();
+ }
// TODO: Handle "not ok" response to D7
#endif
// Ask the coke machine
- sprintf(tmp, "s%i\r\n", Item);
- write(giCoke_SerialFD, tmp, 4);
+ Writef("s%i\r\n", Item);
#if TRACE_COKE
printf("Coke_CanDispense: reading response\n");
#endif
// Read from the machine (ignoring empty lines)
while( (ret = ReadLine(sizeof(tmp)-1, tmp)) == 0 );
+ #if TRACE_COKE
printf("ret = %i, tmp = '%s'\n", ret, tmp);
- if( tmp[0] == ':' ) {
+ #endif
+ // Read back-echoed lines
+ while( tmp[0] == ':' || tmp[1] != 'l' )
+ {
ret = ReadLine(sizeof(tmp)-1, tmp);
printf("ret = %i, tmp = '%s'\n", ret, tmp);
}
// Get slot status
tmp[ matches[3].rm_eo ] = '\0';
status = &tmp[ matches[3].rm_so ];
-
- printf("Machine responded slot status '%s'\n", status);
#if TRACE_COKE
- printf("Coke_CanDispense: done");
+ printf("Coke_CanDispense: Machine responded slot status '%s'\n", status);
#endif
if( strcmp(status, "full") == 0 )
int Coke_DoDispense(int UNUSED(User), int Item)
{
char tmp[32];
- int i, ret;
+ int ret;
// Sanity please
if( Item < 0 || Item > 6 ) return -1;
#if TRACE_COKE
printf("Coke_DoDispense: sending 'd7'\n");
#endif
- write(Item, "d7\r\n", 4);
+ Writef("d7\r\n");
}
#if TRACE_COKE
printf("Coke_DoDispense: sending 'd%i'\n", Item);
#endif
// Dispense
- sprintf(tmp, "d%i\r\n", Item);
- write(giCoke_SerialFD, tmp, 4);
+ Writef("d%i\r\n", Item);
- // Read empty lines
- while( (ret = ReadLine(sizeof(tmp)-1, tmp)) == -1 );
- if( ret == -1 ) return -1;
- // Read d%i
- while( tmp[0] == ':' ) {
+ // Read empty lines and echo-backs
+ do {
ret = ReadLine(sizeof(tmp)-1, tmp);
if( ret == -1 ) return -1;
- }
- // Get status
- ret = ReadLine(sizeof(tmp)-1, tmp);
- if( ret == -1 ) return -1;
+ #if TRACE_COKE
+ printf("Coke_DoDispense: read %i '%s'\n", ret, tmp);
+ #endif
+ } while( ret == 0 || tmp[0] == ':' || tmp[0] == 'd' );
WaitForColon(); // Eat up rest of response
return ch;
}
+int Writef(const char *Format, ...)
+{
+ va_list args;
+ int len;
+
+ va_start(args, Format);
+ len = vsnprintf(NULL, 0, Format, args);
+ va_end(args);
+
+ {
+ char buf[len+1];
+ va_start(args, Format);
+ vsnprintf(buf, len+1, Format, args);
+ va_end(args);
+
+ #if DEBUG
+ printf("Writef: %s", buf);
+ #endif
+
+ return write(giCoke_SerialFD, buf, len);
+ }
+
+}
+
int WaitForColon()
{
fd_set readfs;