![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
fdas
Motor3_L298N/Moter3_L298N.cpp
- Committer:
- brainliang
- Date:
- 2018-05-06
- Revision:
- 0:13ba01a70b4a
File content as of revision 0:13ba01a70b4a:
#include "Moter3_L298N.h" #include "mbed.h" #define HIGH 1 #define LOW 0 Motor_3::Motor_3(PinName dia1,PinName dia2,PinName pwa): _dia1(dia1),_dia2(dia2),_pwa(pwa),_paspeed(0) { //init DigitalOut pda1(_dia1,LOW); DigitalOut pda2(_dia2,LOW); } void Motor_3::mv(float speed) { PwmOut mypwa(_pwa); mypwa.period_ms(20); speed=speed/100*20/1000; if(speed>0) { DigitalOut mydia1(_dia1,HIGH); DigitalOut mydia2(_dia2,LOW); _paspeed=speed; mypwa.pulsewidth(_paspeed); } else if (speed<0) { speed=abs(speed); DigitalOut mydia1(_dia1,LOW); DigitalOut mydia2(_dia2,HIGH); _paspeed=speed; mypwa.pulsewidth(_paspeed); } else { speed=abs(speed); DigitalOut mydia1(_dia1,LOW); DigitalOut mydia2(_dia2,LOW); _paspeed=speed; mypwa.pulsewidth(_paspeed); } } void Motor_3::stop() { DigitalOut pda1(_dia1,LOW); DigitalOut pda2(_dia2,LOW); }