Tristan Vlogman / Mbed 2 deprecated locomotion_pid_action_refactor_EMG

Control up to two motors using filtered EMG signals and a PID controller

Dependencies:   FastPWM HIDScope MODSERIAL QEI Matrix biquadFilter controller errorFetch mbed motorConfig refGen MatrixMath inverseKinematics

Fork of Minor_test_serial by First Last

main.cpp

Committer:
tvlogman
Date:
2017-09-12
Revision:
4:f74c981d9bc0
Parent:
3:99a568200720
Child:
5:d396168a1b20

File content as of revision 4:f74c981d9bc0:

#include "mbed.h"
#include "MODSERIAL.h"

DigitalOut ledG(LED_GREEN);
DigitalOut ledR(LED_RED);
DigitalOut ledB(LED_BLUE);
MODSERIAL pc(USBTX, USBRX);

int main()
{
    //int i = 0;
    pc.baud(115200);
    pc.printf("Hello World!\r\n");
    
    ledR = true;
    ledB = true;
    ledG = true;
    
    while (true) {
        int keyPress = pc.getc();
        pc.putc(keyPress);
        pc.printf("%i", keyPress);
        
        if(keyPress == 114)
        {
            ledG = true;
            ledB = true;
            ledR = !ledR;    
        }
        else if(keyPress == 103)
        {
            ledR = true;
            ledB = true;
            ledG = !ledG;    
        }
        else if(keyPress == 98)
        {
            ledR = true;
            ledG = true;
            ledB = !ledB;    
        }
        else
        {
            ledG = true;
            ledB = true;
            ledR = true;    
        }
        
    }
}