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

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

main.cpp

Committer:
freek100
Date:
2019-09-20
Revision:
0:1843eec2b552
Child:
1:68f74b2ceb7d

File content as of revision 0:1843eec2b552:

#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);
    }
}