T Nara / Mbed 2 deprecated robottt

ok

Dependencies:   ACM1602 mbed

Diff: main.cpp

Revision:
2:06791a891865
Parent:
1:daff0eea2103
Child:
3:3ff6832ca952
--- a/main.cpp	Sat Jan 23 08:12:01 2016 +0000
+++ b/main.cpp	Thu Jan 28 01:12:00 2016 +0000
@@ -16,6 +16,8 @@
 AnalogIn sticky(p15);
 AnalogIn stickx(p16);
 AnalogIn speed(p17);
+AnalogIn RT(p19);
+AnalogIn LT(p20);
 Serial pc(USBTX,USBRX);
 uint8_t getdeg(){
     int counter = 0;
@@ -82,14 +84,17 @@
     return x;
 }
 int main() {
-    uint8_t deg,speed;
+    uint8_t deg,speedr,speedl;
     while(1) {
+        speedr = (0.7-RT)*360;
+        speedl = (0.7-LT)*360;
         deg = getdeg();
-        speed = getspeed();
+        //speed = getspeed();
         Xbee.putc(255);
         Xbee.putc(deg);
-        Xbee.putc(speed);
-        printf("%d\n",deg);
+        Xbee.putc(speedr);
+        Xbee.putc(speedl);
+        //printf("%d,%d\n",speedl,speedr);
         wait(0.1);
     }
 }