Sadaei Osakabe
/
GSwifiInterface_HelloServo
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: GSwifiInterface Servo mbed
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
--- /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
--- /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
--- /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
--- /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