Betago
/
testmotoe
1
move.cpp
- Committer:
- palmdotax
- Date:
- 2016-06-27
- Revision:
- 0:c52fc2fdd2e0
File content as of revision 0:c52fc2fdd2e0:
#include "mbed.h" #include "move.h" #include "mbed.h" DigitalOut dir1(PA_10);//PA_10 DigitalOut dir2(PB_3);//PB_3 PwmOut speeds(PB_4); DigitalOut dirr1(PA_9);//PA_8 DigitalOut dirr2(PC_7);//PB_5 PwmOut speeds2(PB_10); DigitalOut relays(PA_8); void move:: movespeed_1(float setpoint,float spd) { float dc=0; if(setpoint>=0) { dir1=1; dir2=0; // printf("if1\n"); } else { dir1=0; dir2=1; // printf("else1\n"); } dc=setpoint+spd; // printf("%f\n",dc); speeds2.write(dc); } void move:: movespeed_2(float setpoint,float spd) { double dc=0; if(setpoint>=0) { dirr1=1; dirr2=0; // printf("if2\n"); } else { dirr1=0; dirr2=1; // printf("else2\n"); } dc=setpoint+spd; // printf("%f\n",dc); speeds.write(dc); } void move::pump(int on_off) { relays=on_off; }