complete motor
Dependencies: BufferedSerial motor_sn7544
main.cpp
- Committer:
- kangmingyo
- Date:
- 2019-05-23
- Revision:
- 2:a04440f0d001
- Parent:
- 1:1d18a2e8ce45
- Child:
- 3:0c6258635590
File content as of revision 2:a04440f0d001:
#include "mbed.h" #include "motor.h" MotorCtl motor1(D3,D12,D4,D5); InterruptIn tachoINT1(D4); InterruptIn tachoINT2(D5); Serial pc(USBTX,USBRX,115200); char rx_buffer[10]; int index=0; volatile int flag; void update_current(void) { motor1.UpdateCurrentPosition(); // pc.printf("Update Position\r\n"); } void rx_cb(void){ char ch; ch = pc.getc(); pc.putc(ch); rx_buffer[index++]=ch; if(ch==0x0D){ pc.putc(0x0A); rx_buffer[--index]='\0'; index=0; flag=1; } } int set_speed(void) { int speed; speed = atoi((const char*)rx_buffer); if(speed>78){speed=78;} if(speed<-78){speed=-78;} motor1.setTarget(speed); pc.printf(" Set speed = %d\r\n", speed); return speed; } int main() { tachoINT1.fall(&update_current); tachoINT1.rise(&update_current); tachoINT2.fall(&update_current); tachoINT2.rise(&update_current); pc.attach(callback(rx_cb)); int rpm; while(1) { flag=0; pc.printf("Enter the value for speed [-78,78]\r\n"); while(flag!=1) { rpm=motor1.getRPM(); pc.printf("rpm = %d\r\n",rpm); wait(1); } set_speed(); } }