Diff: main.cpp

Revision:

0:c05fdb9d1e8a

Child:

1:28c58a355b7f

diff -r 000000000000 -r c05fdb9d1e8a main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Jan 23 22:31:04 2015 +0000
@@ -0,0 +1,229 @@
+#include "mbed.h"
+#include "DSGatewayMBED.h"
+#include <string>
+
+#define MAX_S88DECODER 1
+#define RELPYERROR_300 "300 Command error"
+#define RELPYERROR_301 "301 Syntax error"
+#define RELPYERROR_302 "302 receive timeout"
+#define RELPYERROR_303 "303 Unknown error"
+#define RELPYERROR_NONE ""
+
+/* class definition */
+Serial serial_pc(SERIAL_TX, SERIAL_RX);
+DSGatewayLib ds_gw;
+
+int gCounter = 0;
+string gReceivedMessage;
+word numOfArguments;
+string function;
+word arguments[8];
+
+/* function definition */
+word stringToWord(string s);
+void decodeSerialMessage(string inMessage);
+std::string trim(const std::string& string, const char* trimCharacterList);
+boolean ParseMessage(string inRequestText);
+boolean dispatch();
+
+/* Implementation  */
+
+void decodeSerialMessage(string inMessage)
+{
+    string aReplyText = RELPYERROR_NONE;
+   
+    if( ParseMessage(inMessage) == true)
+    {
+       
+        if( dispatch() == true)
+        {
+            /* Parse successed */
+            serial_pc.printf("200 Ok");
+        }
+        else
+        {
+            serial_pc.printf(RELPYERROR_300);
+        }
+    }
+    else
+    {
+        /* Parse failed */
+        serial_pc.printf(RELPYERROR_301);
+    }
+    
+    /* Reply to Desktop Station */
+    serial_pc.printf("\n");
+    
+}
+
+std::string trim(const std::string& string, const char* trimCharacterList = " \t\v\r\n")
+{
+std::string result;
+ 
+std::string::size_type left = string.find_first_not_of(trimCharacterList);
+ 
+if (left != std::string::npos)
+{
+// 左側からトリムする文字以外が見つかった場合は、同じように右側からも検索します。
+std::string::size_type right = string.find_last_not_of(trimCharacterList);
+ 
+// 戻り値を決定します。ここでは右側から検索しても、トリムする文字以外が必ず存在するので判定不要です。
+result = string.substr(left, right - left + 1);
+}
+ 
+return result;
+}
+
+boolean ParseMessage(string inRequestText)
+{
+  int lpar = inRequestText.find('(');
+  if (lpar == -1) {
+    return false;
+  }
+  
+  function = string(inRequestText.substr(0, lpar));
+  trim(function);
+              
+  int offset = lpar + 1;
+  int comma = inRequestText.find(',', offset);
+  numOfArguments = 0;
+  while (comma != -1) {
+    string tmp = inRequestText.substr(offset, comma - offset);
+    trim(tmp);
+    arguments[numOfArguments++] = stringToWord(tmp);
+    offset = comma + 1;
+    comma = inRequestText.find(',', offset);
+  }
+
+  int rpar = inRequestText.find(')', offset);
+  while (rpar == -1) {
+    return false;
+  }
+  
+  if (rpar > offset) {
+    string tmp = inRequestText.substr(offset, rpar - offset);
+    trim(tmp);
+    arguments[numOfArguments++] = stringToWord(tmp);
+  }
+  
+  return true;
+}
+
+word stringToWord(string s)
+{
+  word result = 0;
+  
+  for (int i = 0; i < s.length(); i++) {
+    result = 10 * result + (s.at(i) - '0');
+  }
+  
+  return result;
+}
+
+// Serial receiver (IRQ)
+void isrRx() {
+    char ch;
+    ch = serial_pc.getc();         // 1文字受信バッファより取り出し
+    
+    if(ch != '\n')
+    {
+        gReceivedMessage = gReceivedMessage + ch;
+        gCounter++;
+    }
+    else
+    {
+        /* Decode the commands from PC */
+        decodeSerialMessage(gReceivedMessage);
+        
+        gCounter = 0;
+        gReceivedMessage = "";
+    }
+    
+}
+
+boolean dispatch() {
+  boolean aResult;
+
+  if (function.compare("setLocoDirection") == 0) {
+    return ds_gw.SetLocoDirection(arguments[0], (unsigned char)arguments[1]);
+    
+  } else if (function.compare("setLocoFunction") == 0) {
+    return ds_gw.SetLocoFunction(arguments[0], arguments[1], (byte)arguments[2]);
+    
+  } else if (function.compare("setTurnout") == 0) {
+    return ds_gw.SetTurnout(arguments[0], (byte)arguments[1]);
+    
+  } else if (function.compare("setPower") == 0) {
+    return ds_gw.SetPower((byte)arguments[0]);
+    
+  } else if (function.compare("setLocoSpeed") == 0) {
+    return ds_gw.SetLocoSpeed(arguments[0], arguments[1]);
+  }
+  else if (function.compare("getS88") == 0)
+  {
+    int aMaxS88Num = MAX_S88DECODER;
+    
+    if( arguments[0] > 0)
+    {
+        aMaxS88Num = arguments[0];
+    }
+
+    //reporter.refresh(aMaxS88Num);
+
+    //Send a S88 sensor reply 
+    serial_pc.printf("@S88,");
+
+    word aFlags = 0;
+
+    for( int j = 0; j < aMaxS88Num; j++)
+    {
+      //aFlags = (reporter.getByte((j << 1) + 1) << 8) + reporter.getByte(j << 1);
+      aFlags = 0;
+      
+      serial_pc.printf("%x", aFlags);
+      serial_pc.printf(",");
+    }
+        
+    serial_pc.printf("\n");
+    
+    return true;
+    
+  } /* getS88 */
+  else if (function.compare("reset") == 0)
+  {
+  
+    serial_pc.printf("100 Ready\n");
+    
+    return true;
+  } /* reset */
+  else if (function.compare("setPing") == 0) {
+      serial_pc.printf("@DSG,001,\n");
+    return true;
+  }
+  else
+  {
+    return false;
+  }
+  
+}
+ 
+int main() {
+    
+    //initialization
+    serial_pc.baud(115200);
+    //serial_pc.format(8, 0, 1);
+    serial_pc.attach(isrRx, Serial::RxIrq);
+    
+      serial_pc.printf("--------------------------------------\n");
+      serial_pc.printf("Desktop Station Gateway               \n");
+      serial_pc.printf("--------------------------------------\n");
+      serial_pc.printf("100 Ready\n");
+      
+      ds_gw.begin();
+    
+    while(1) {
+        wait_ms(50);
+        
+            }
+}
+ 
\ No newline at end of file