Afgesplitste versie van motor control waarbij we ook iets met EMG gaan doen

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

Revision:
0:1843eec2b552
Child:
1:68f74b2ceb7d
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Sep 20 12:38:05 2019 +0000
@@ -0,0 +1,33 @@
+#include "mbed.h"
+//#include "HIDScope.h"
+#include "QEI.h"
+#include "MODSERIAL.h"
+//#include "BiQuad.h"
+//#include "FastPWM.h"
+
+DigitalOut ledr(LED_RED);
+DigitalOut ledg(LED_GREEN);
+DigitalOut ledb(LED_BLUE);
+PwmOut led1(D10);
+DigitalIn button1(D2);
+AnalogIn potmeter(A1);
+DigitalIn sw(SW2);
+MODSERIAL pc(USBTX, USBRX);
+DigitalIn encA(D13);
+DigitalIn encB(D12);
+QEI encoder(D13,D12,NC,64,QEI::X4_ENCODING);
+
+int counts;
+float degree;
+float factor= 5.625;
+int main()
+{
+    pc.baud(115200);
+    pc.printf("\r\nStarting...\r\n\r\n");
+    while (true) {
+        counts= encoder.getPulses();
+        degree= counts*factor;
+        pc.printf("%f \r\n", degree);
+        wait(0.5);
+    }
+}