GGController
Dependencies: BufferedSerial DRV8833 mbed
Fork of HelloWorld by
main.cpp
- Committer:
- mrayy
- Date:
- 2015-10-20
- Revision:
- 2:375e29585498
- Parent:
- 0:fb6bbc10ffa0
File content as of revision 2:375e29585498:
#include "mbed.h" #include "DRV8833.h" #include "BufferedSerial.h" DigitalOut led1(LED1); DigitalOut led2(LED2); DigitalOut led3(LED3); DigitalOut led4(LED4); Serial pc(USBTX, USBRX); int err; DRV8833 motor1(p21,p22); DRV8833 motor2(p23,p24); DRV8833 motor3(p25,p26); int main() { pc.baud(115200); motor1.period(0.0000035f); motor2.period(0.0000035f); motor3.period(0.0000035f); float s1,s2,s3; while (1) { if(pc.readable()) { char c; err=pc.scanf("%c",&c); if(c=='t') { pc.printf("r\n"); led2 = 1; wait(0.1); led2=0; }else if(c=='d') { // printf("reading bytes\n"); int m1,m2,m3; err=pc.scanf("%d %d %d",&m1,&m2,&m3); s1=(float)(m1)/(float)1000.0f; s2=(float)(m2)/(float)1000.0f; s3=(float)(m3)/(float)1000.0f; motor1.speed(s1); motor2.speed(s2); motor3.speed(s3); // printf("%f,%f,%f\n",s1,s2,s3); } // led1 = !led1; } } }