![](/media/cache/group/9e3cc099b3b04bca937a1cca1da81b19.jpg.50x50_q85.jpg)
Afgesplitste versie van motor control waarbij we ook iets met EMG gaan doen
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?
User | Revision | Line number | New 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 | } |