Dependencies: FastPWM MODSERIAL mbed QEI
Fork of Motorcontrol by
Diff: main.cpp
- Revision:
- 3:bfb7f197991f
- Parent:
- 2:ba344767412c
--- a/main.cpp Fri Sep 28 09:13:19 2018 +0000 +++ b/main.cpp Mon Oct 08 07:23:44 2018 +0000 @@ -1,61 +1,27 @@ #include "mbed.h" -#include "FastPWM.h" #include "MODSERIAL.h" -Ticker Motorticker; +//PC.PRINTF IN TICKER WERKT BIJ MBED REVISION 150!!! -FastPWM motor1_pwm(D5); -DigitalOut motor1_richting(D4); -FastPWM motor2_pwm(D6); -DigitalOut motor2_richting(D7); - -AnalogIn pot1(A1); -AnalogIn pot2(A0); +DigitalOut ledr(LED_RED); +DigitalOut ledb(LED_BLUE); +DigitalOut ledg(LED_GREEN); +DigitalIn button(PTC6); MODSERIAL pc(USBTX, USBRX); -void Motor_control() +Ticker TickerChangecolor; + + +void ColorLed() { - pc.baud(115200); - - float AnalogVoltage1 = pot1.read()*2 - 1; - float AnalogVoltage2 = pot2.read()*2 - 1; - pc.printf("pot1 = %f \t pot2 = %f \r\n", AnalogVoltage1, AnalogVoltage2); - - //Motor1 - - if (AnalogVoltage1 <= 0) - { - motor1_richting = 0; - motor1_pwm.write(-AnalogVoltage1); //write Duty cycle - } - - if (AnalogVoltage1 >= 0) - { - motor1_richting = 1; - motor1_pwm.write(AnalogVoltage1); //write Duty cycle - } - - //Motor 2 - - if (AnalogVoltage2 <= 0) - { - motor2_richting = 0; - motor2_pwm.write(-AnalogVoltage2); //write Duty cycle - } - if (AnalogVoltage2 >= 0) - { - motor2_richting = 1; - motor2_pwm.write(AnalogVoltage2); //write Duty cycle - } + pc.printf("En de kleur wordt...\r\n"); + ledr=!ledr; } int main() { - int frequency_pwm = 16700; //16.7 kHz PWM - - Motorticker.attach(Motor_control,0.1); - motor1_pwm.period(1.0/frequency_pwm); // T = 1/f - - while(true) - {} + pc.baud(115200); + TickerChangecolor.attach(ColorLed, 0.5); + while(true) + {} } \ No newline at end of file