Kyo Ashizuka
/
DC_Motor2
直流モータ2個を,2つのアナログ入力でデューティ制御するプログラムです。
main.cpp
- Committer:
- Yoshichan
- Date:
- 2014-08-03
- Revision:
- 0:c4b58f8a436e
File content as of revision 0:c4b58f8a436e:
// Sweep the motor speed from full-speed reverse (-1.0) to full speed forwards (1.0) #include "mbed.h" #include "Motor.h" Motor m1(p23, p6, p5); // pwm, fwd, rev AnalogIn ain1(p16);// AD input for Motor1 Motor m2(p22, p8, p7); // pwm, fwd, rev AnalogIn ain2(p15);// AD input for Motor2 int main() { while(1) { float k1=(ain1-0.5)*1.2; if(k1>0.6) { k1=0.6; } else { if(k1<-0.6) { k1=-0.6; } else{} } float k2=(ain2-0.5)*1.2; if(k2>0.6) { k2=0.6; } else { if(k2<-0.6) { k2=-0.6; } else{} } m1.speed(k1); m2.speed(k2); wait(0.1); } }