T Nara
/
robottt
ok
Diff: main.cpp
- Revision:
- 2:06791a891865
- Parent:
- 1:daff0eea2103
- Child:
- 3:3ff6832ca952
diff -r daff0eea2103 -r 06791a891865 main.cpp --- 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); } }