eLab Team / Mbed OS DcMotorTest
Committer:
elab
Date:
Thu Jan 28 15:51:12 2021 +0000
Revision:
1:77096ac47e7a
Parent:
0:708b17957be1
tets;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
elab 0:708b17957be1 1 #include "mbed.h"
elab 0:708b17957be1 2
elab 0:708b17957be1 3
elab 0:708b17957be1 4 PwmOut DCMotor(D6);
elab 0:708b17957be1 5 PwmOut ServoClockWise(D5);
elab 0:708b17957be1 6 PwmOut ServoCounterCW(D3);
elab 0:708b17957be1 7
elab 0:708b17957be1 8 DigitalOut DCMotor_IN1(D7);
elab 0:708b17957be1 9 DigitalOut DCMotor_IN2(D8);
elab 0:708b17957be1 10 DigitalOut ServoEnable(D4);
elab 0:708b17957be1 11
elab 0:708b17957be1 12
elab 0:708b17957be1 13
elab 0:708b17957be1 14 int main()
elab 0:708b17957be1 15 {
elab 0:708b17957be1 16 DCMotor.period_ms(20); // shoul be 20 ms (490 Hz) and 10 ms for the servo (980 Hz)
elab 0:708b17957be1 17 ServoClockWise.period_ms(10);
elab 0:708b17957be1 18 ServoCounterCW.period_ms(10);
elab 0:708b17957be1 19 ServoEnable=1;
elab 0:708b17957be1 20
elab 0:708b17957be1 21 DCMotor_IN1=0;
elab 0:708b17957be1 22 DCMotor_IN2=1;
elab 0:708b17957be1 23 DCMotor.pulsewidth_us(1500);
elab 0:708b17957be1 24 // wait(5);
elab 0:708b17957be1 25 // DCMotor.pulsewidth_ms(0);
elab 0:708b17957be1 26
elab 0:708b17957be1 27
elab 0:708b17957be1 28
elab 0:708b17957be1 29 while(0){
elab 0:708b17957be1 30
elab 0:708b17957be1 31 DCMotor_IN1=0;
elab 0:708b17957be1 32 DCMotor_IN2=1;
elab 0:708b17957be1 33 DCMotor.pulsewidth_ms(2);
elab 0:708b17957be1 34 ServoClockWise.pulsewidth_us(0);
elab 0:708b17957be1 35 ServoCounterCW.pulsewidth_us(100);
elab 0:708b17957be1 36 wait_ms(1000);
elab 0:708b17957be1 37 ServoCounterCW.pulsewidth_us(19000);
elab 0:708b17957be1 38 wait_ms(1000);
elab 0:708b17957be1 39
elab 0:708b17957be1 40 DCMotor_IN1=1;
elab 0:708b17957be1 41 DCMotor_IN2=0;
elab 0:708b17957be1 42 DCMotor.pulsewidth_ms(10);
elab 0:708b17957be1 43 ServoCounterCW.pulsewidth_us(0);
elab 0:708b17957be1 44 ServoClockWise.pulsewidth_us(100);
elab 0:708b17957be1 45 wait_ms(1000);
elab 0:708b17957be1 46 ServoClockWise.pulsewidth_us(19000);
elab 0:708b17957be1 47 wait_ms(1000);
elab 0:708b17957be1 48
elab 0:708b17957be1 49 }
elab 0:708b17957be1 50 }