M9 Biorobotics Group 8 / Mbed 2 deprecated Encoder + Motor Control

Poah als je je encoder in je motor wil aflezen en de beweging van je motor wilt aanpassen is dit programma echt voor jou!

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

main.cpp@0:1843eec2b552, 2019-09-20 (annotated)

Committer:
freek100
Date:
Fri Sep 20 12:38:05 2019 +0000
Revision:
0:1843eec2b552
Child:
1:68f74b2ceb7d
Encoder lezen met draaihoek

Who changed what in which revision?

UserRevisionLine numberNew contents of line
freek100 0:1843eec2b552 1 #include "mbed.h"
freek100 0:1843eec2b552 2 //#include "HIDScope.h"
freek100 0:1843eec2b552 3 #include "QEI.h"
freek100 0:1843eec2b552 4 #include "MODSERIAL.h"
freek100 0:1843eec2b552 5 //#include "BiQuad.h"
freek100 0:1843eec2b552 6 //#include "FastPWM.h"
freek100 0:1843eec2b552 7
freek100 0:1843eec2b552 8 DigitalOut ledr(LED_RED);
freek100 0:1843eec2b552 9 DigitalOut ledg(LED_GREEN);
freek100 0:1843eec2b552 10 DigitalOut ledb(LED_BLUE);
freek100 0:1843eec2b552 11 PwmOut led1(D10);
freek100 0:1843eec2b552 12 DigitalIn button1(D2);
freek100 0:1843eec2b552 13 AnalogIn potmeter(A1);
freek100 0:1843eec2b552 14 DigitalIn sw(SW2);
freek100 0:1843eec2b552 15 MODSERIAL pc(USBTX, USBRX);
freek100 0:1843eec2b552 16 DigitalIn encA(D13);
freek100 0:1843eec2b552 17 DigitalIn encB(D12);
freek100 0:1843eec2b552 18 QEI encoder(D13,D12,NC,64,QEI::X4_ENCODING);
freek100 0:1843eec2b552 19
freek100 0:1843eec2b552 20 int counts;
freek100 0:1843eec2b552 21 float degree;
freek100 0:1843eec2b552 22 float factor= 5.625;
freek100 0:1843eec2b552 23 int main()
freek100 0:1843eec2b552 24 {
freek100 0:1843eec2b552 25 pc.baud(115200);
freek100 0:1843eec2b552 26 pc.printf("\r\nStarting...\r\n\r\n");
freek100 0:1843eec2b552 27 while (true) {
freek100 0:1843eec2b552 28 counts= encoder.getPulses();
freek100 0:1843eec2b552 29 degree= counts*factor;
freek100 0:1843eec2b552 30 pc.printf("%f \r\n", degree);
freek100 0:1843eec2b552 31 wait(0.5);
freek100 0:1843eec2b552 32 }
freek100 0:1843eec2b552 33 }