encoder verwerkt
Dependencies: MODSERIAL QEI mbed
Fork of motor_control by
main.cpp
- Committer:
- daniQQue
- Date:
- 2016-09-30
- Revision:
- 2:80753272d9e4
- Parent:
- 1:e415c6eda278
- Child:
- 3:a50f2ce05e1f
File content as of revision 2:80753272d9e4:
#include "mbed.h" //standaard bieb mbed #include "QEI.h" //bieb voor encoderfuncties in c++ #include "MODSERIAL.h" //bieb voor modserial //alle ingangen definieren DigitalIn encoder1A(D13); DigitalIn encoder1B(D12); DigitalIn button(D11); DigitalOut led(D10); DigitalOut motor1(D4); PwmOut pwm_motor1(D5); MODSERIAL pc(USBTX, USBRX); //constanten const int CW = 0; //definitie rechtsom 'lage waarde' const int CCW =2.5; //definitie linksom 'hoge waarde' //programma int main () { pc.baud(115200); //contact maken met computer int counts; while (knop==1){ //als knop is aan dan led=1; motor = CCW; QEI Encoder(D12,D13,NC,32); counts = Encoder.getPulses(); pc.printf("encoder counts %i", counts); for (int a=0; a<5;a=a++){ pwm_motor =a; wait(2.0f); } int a=0; wait(1.0f); motor=CW; for (int a=1; a<5;a=a++){ pwm_motor= a; wait(1.0f); } a=0; } }