Diff: main.cpp

Revision:

0:26dc9db5d170

Child:

1:91fa4b9c427d

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu May 25 07:54:07 2017 +0000
@@ -0,0 +1,55 @@
+#include "mbed.h"
+#include "TextLCD.h"
+
+TextLCD lcd(PA_0,PA_1,PA_4,PB_0,PC_1,PC_0); // RS, E, D4-D7
+Serial pc(PA_9,PA_10);
+
+DigitalOut myled(LED1);
+char data[2];
+char data1[2];
+char data2[2];
+char data3[2];
+char data4[2];
+char data5[2];
+char data6[2];
+char data7[2];
+char data8[2];
+
+int angleCal(char highc, char lowc);
+ 
+int main() {
+    pc.baud(115200);
+    pc.format(8,SerialBase::None,1);
+    //pc.attach(&interrupt,Serial::RxIrq);
+    
+    
+    while(1) {
+        if (pc.readable()) {
+            pc.gets(data,2);
+            
+            if(data[0] == 170){
+                pc.gets(data1,2); //0xAA
+                pc.gets(data2,2);
+                pc.gets(data3,2);
+                pc.gets(data4,2);
+                pc.gets(data5,2);
+                pc.gets(data6,2);
+                pc.gets(data7,2);
+                pc.gets(data8,2); //0x55
+                lcd.printf("%d,%d,%d",angleCal(data2[0],data3[0]), angleCal(data4[0],data5[0]), angleCal(data6[0],data7[0]));
+            }
+        }
+        wait(1);
+        lcd.cls();
+    }
+}
+
+int angleCal(char highc, char lowc)
+{
+    int high = highc << 8;
+    int low = lowc; 
+    int angle = (high + low)/100;
+    if(angle > 475)
+        angle = 180 + (angle - 476);
+    return angle;
+}
\ No newline at end of file