Revision 0:de06f19dce2b, committed 2013-02-06

Comitter:

diasea

Date:

Wed Feb 06 15:52:47 2013 +0000

Commit message:

Servo controll with gainspan GS1011M wifi module

Changed in this revision

diff -r 000000000000 -r de06f19dce2b GSwifiInterface.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/GSwifiInterface.lib	Wed Feb 06 15:52:47 2013 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/gsfan/code/GSwifiInterface/#6a6396b56405

diff -r 000000000000 -r de06f19dce2b Servo.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Servo.lib	Wed Feb 06 15:52:47 2013 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/simon/code/Servo/#36b69a7ced07

diff -r 000000000000 -r de06f19dce2b main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Feb 06 15:52:47 2013 +0000
@@ -0,0 +1,101 @@
+#include "mbed.h"
+#include "GSwifiInterface.h"
+#include "Servo.h"
+
+Servo servo1(p22);
+Servo servo2(p23);
+
+Serial pc(USBTX, USBRX);
+
+GSwifiInterface gs(p13, p14, NC, NC, p9, "SSID", "PHRASE", GSwifi::SEC_WPA_PSK);
+// TX, RX, CTS, RTS, RESET
+
+unsigned char buff[30];
+int RecvCount = 0;
+int ParamLen = 0;
+int ParamCount = 0;
+void Recv(unsigned char data);
+void ServoCmdExec();
+
+int main () {
+    pc.baud(115200);
+    RecvCount = 0;
+    ParamLen = 0;
+    ParamCount = 0;
+    servo1 = 0.5f;
+    servo2 = 0.5f;
+    pc.printf("OK");
+
+    gs.init("192,168,1,17", "255,255,255,0", "192,168,1,254"); // use Static IP
+    if (gs.connect() == false) {
+        return -1; // join the network
+    }
+    printf("IP Address is %s\n\r", gs.getIPAddress());
+    
+    TCPSocketServer server;
+    server.bind(10002);
+    server.listen();
+    
+    while (true) {
+        printf("\nWait for new connection...\n");
+        TCPSocketConnection client;
+        server.accept(client);
+        client.set_blocking(false, 1500); // Timeout after (1.5)s
+        
+        printf("Connection from: %s\n", client.get_address());
+        char buf[300];
+        while (true) {
+            int len = client.receive(buf, sizeof(buf));
+            for (int i = 0; i < len; i++) {
+                Recv((unsigned char)buf[i]);
+            }
+        }
+        
+        client.close();
+    }
+
+    gs.disconnect();
+}
+
+void Recv(unsigned char data) {
+    switch (RecvCount) {
+        case 0:
+            ParamLen = 0;
+            ParamCount = 0;
+            if (data == 0xff) { // Headder
+                buff[RecvCount++] = data;
+            }
+            break;
+        case 1:
+            if (data == 0) {    // ID
+                buff[RecvCount++] = data;
+            }
+            break;
+        case 2:                 // LENGTH
+            buff[RecvCount++] = data;
+            ParamLen = data;
+            break;
+        default:
+            if (ParamLen > 0) {
+                buff[RecvCount++] = data;
+                ParamCount++;
+                if (ParamCount >= ParamLen) {
+                    ServoCmdExec();
+                    RecvCount = 0;
+                }
+            } else {
+                RecvCount = 0;
+            }
+            break;
+    }
+}
+
+void ServoCmdExec() {
+    float tmp1 = (float)buff[4]/255.0f;
+    float tmp2 = (float)buff[5]/255.0f;
+    servo1 = tmp1;
+    servo2 = tmp2;
+
+    pc.printf("servo1 = %02Xh %.1f",buff[4],tmp1);
+    pc.printf("servo2 = %02Xh %.1f",buff[5],tmp2);
+}
\ No newline at end of file

diff -r 000000000000 -r de06f19dce2b mbed.bld
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed.bld	Wed Feb 06 15:52:47 2013 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/mbed_official/code/mbed/builds/0954ebd79f59
\ No newline at end of file