2 motoren, pins correct
Dependencies: MODSERIAL mbed QEI
Fork of PWM_motor by
main.cpp@0:0cb350eb704a, 2018-09-28 (annotated)
- Committer:
- felixdransfeld
- Date:
- Fri Sep 28 09:42:48 2018 +0000
- Revision:
- 0:0cb350eb704a
- Child:
- 1:2ec710725db2
Dit is de code om de motor te laten werken - the basics
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
felixdransfeld | 0:0cb350eb704a | 1 | #include "mbed.h" |
felixdransfeld | 0:0cb350eb704a | 2 | #include "MODSERIAL.h" |
felixdransfeld | 0:0cb350eb704a | 3 | |
felixdransfeld | 0:0cb350eb704a | 4 | AnalogIn pot1(A1); |
felixdransfeld | 0:0cb350eb704a | 5 | AnalogIn pot2(A2); |
felixdransfeld | 0:0cb350eb704a | 6 | DigitalIn encoder(D7); |
felixdransfeld | 0:0cb350eb704a | 7 | PwmOut pwmpin(D5); |
felixdransfeld | 0:0cb350eb704a | 8 | DigitalOut directionpin(D4); |
felixdransfeld | 0:0cb350eb704a | 9 | DigitalOut directionpin2(D6); |
felixdransfeld | 0:0cb350eb704a | 10 | MODSERIAL pc(USBTX, USBRX); |
felixdransfeld | 0:0cb350eb704a | 11 | |
felixdransfeld | 0:0cb350eb704a | 12 | int main() |
felixdransfeld | 0:0cb350eb704a | 13 | { |
felixdransfeld | 0:0cb350eb704a | 14 | pc.baud(9600); |
felixdransfeld | 0:0cb350eb704a | 15 | |
felixdransfeld | 0:0cb350eb704a | 16 | pwmpin.period_us(60); //60 microsecondsPWM period, 16.7 kHz |
felixdransfeld | 0:0cb350eb704a | 17 | //float ain1; |
felixdransfeld | 0:0cb350eb704a | 18 | //float ain2; |
felixdransfeld | 0:0cb350eb704a | 19 | |
felixdransfeld | 0:0cb350eb704a | 20 | while(true){ |
felixdransfeld | 0:0cb350eb704a | 21 | // ain1 = pot1.read(); |
felixdransfeld | 0:0cb350eb704a | 22 | // ain2 = pot2.read(); |
felixdransfeld | 0:0cb350eb704a | 23 | |
felixdransfeld | 0:0cb350eb704a | 24 | float u = -0.9f; //determineusefulvalue, -0.3f is justanexample |
felixdransfeld | 0:0cb350eb704a | 25 | directionpin= u > 0.0f; //eithertrueor false |
felixdransfeld | 0:0cb350eb704a | 26 | pwmpin= fabs(u); //pwmduty cycle canonlybepositive, floatingpoint absolute value |
felixdransfeld | 0:0cb350eb704a | 27 | |
felixdransfeld | 0:0cb350eb704a | 28 | wait(0.5f); |
felixdransfeld | 0:0cb350eb704a | 29 | |
felixdransfeld | 0:0cb350eb704a | 30 | printf("Motorsnelheid %i \n \r", encoder); |
felixdransfeld | 0:0cb350eb704a | 31 | |
felixdransfeld | 0:0cb350eb704a | 32 | } |
felixdransfeld | 0:0cb350eb704a | 33 | } |