Laurence B / Mbed 2 deprecated Motorcontrol

11.06 - Versie beide motors draaien afhankelijk van potmeter

Dependencies:   FastPWM MODSERIAL mbed

main.cpp@0:dacd23e75c5c, 2018-09-28 (annotated)

Committer:
laurencebr
Date:
Fri Sep 28 08:51:34 2018 +0000
Revision:
0:dacd23e75c5c
Child:
1:621c4bb5301d
versie motor draait op juiste snelheid;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
laurencebr 0:dacd23e75c5c 1 #include "mbed.h"
laurencebr 0:dacd23e75c5c 2 #include "FastPWM.h"
laurencebr 0:dacd23e75c5c 3 #include "MODSERIAL.h"
laurencebr 0:dacd23e75c5c 4
laurencebr 0:dacd23e75c5c 5 FastPWM motor1_pwm(D5);
laurencebr 0:dacd23e75c5c 6 DigitalOut motor1_richting(D4);
laurencebr 0:dacd23e75c5c 7
laurencebr 0:dacd23e75c5c 8 AnalogIn pot1(A1);
laurencebr 0:dacd23e75c5c 9 AnalogIn pot2(A0);
laurencebr 0:dacd23e75c5c 10 MODSERIAL pc(USBTX, USBRX);
laurencebr 0:dacd23e75c5c 11
laurencebr 0:dacd23e75c5c 12
laurencebr 0:dacd23e75c5c 13
laurencebr 0:dacd23e75c5c 14 int main()
laurencebr 0:dacd23e75c5c 15 {
laurencebr 0:dacd23e75c5c 16 int frequency_pwm = 16700; //16.7 kHz PWM
laurencebr 0:dacd23e75c5c 17
laurencebr 0:dacd23e75c5c 18
laurencebr 0:dacd23e75c5c 19 motor1_pwm.period(1.0/frequency_pwm); // T = 1/f
laurencebr 0:dacd23e75c5c 20
laurencebr 0:dacd23e75c5c 21 while(true){
laurencebr 0:dacd23e75c5c 22
laurencebr 0:dacd23e75c5c 23 pc.baud(115200);
laurencebr 0:dacd23e75c5c 24
laurencebr 0:dacd23e75c5c 25 float AnalogVoltage1 = pot1.read()*2 - 1;
laurencebr 0:dacd23e75c5c 26 float AnalogVoltage2 = pot2.read()*2 - 1;
laurencebr 0:dacd23e75c5c 27 pc.printf("pot1 = %f \t pot2 = %f \r\n", AnalogVoltage1, AnalogVoltage2);
laurencebr 0:dacd23e75c5c 28
laurencebr 0:dacd23e75c5c 29 if (AnalogVoltage1 <= 0) {
laurencebr 0:dacd23e75c5c 30 motor1_richting = 0;
laurencebr 0:dacd23e75c5c 31 motor1_pwm.write(-AnalogVoltage1); //write Duty cycle
laurencebr 0:dacd23e75c5c 32 }
laurencebr 0:dacd23e75c5c 33 if (AnalogVoltage1 >= 0) {
laurencebr 0:dacd23e75c5c 34 motor1_richting = 1;
laurencebr 0:dacd23e75c5c 35 motor1_pwm.write(AnalogVoltage1); //write Duty cycle
laurencebr 0:dacd23e75c5c 36 }
laurencebr 0:dacd23e75c5c 37
laurencebr 0:dacd23e75c5c 38
laurencebr 0:dacd23e75c5c 39
laurencebr 0:dacd23e75c5c 40 }
laurencebr 0:dacd23e75c5c 41 }