Code of the EMG Controlled Robot "The Claw"

Dependencies:   MODSERIAL Motordriver QEI Servo mbed

Fork of Button_BCA by Meike Froklage

main.cpp

Committer:
megrootens
Date:
2016-09-20
Revision:
1:1d2208dce484
Parent:
0:048fbd80203e
Child:
2:ad4b181a6422

File content as of revision 1:1d2208dce484:

/**
 * Minor BioRobotics 2016
 *
 * Programming Homework Set 2
 * Exercise 2, example solution.
 *
 * Note that this problem can be solved in *much* cleaner ways, using slightly 
 * more advanced C++ / programming techniques. However, this example shows that
 * even with very basic programming skills quite a lot can be achieved.
 *
 * M.E. Grootens [at] utwente.nl,
 * v0.1, 16.09.2016
 */

#include "mbed.h"

// = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = >
// Serial communication using MODSERIAL
#define SERIAL_BAUD 115200  // baud rate for serial communication
#include "MODSERIAL.h"
MODSERIAL pc(USBTX,USBRX);

// = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = >
// Timing
const float kTimeLedToggle = 0.25f; // period with which to toggle LED
const float kTimePrintSerial = 1.0f;// period with which data is printed

// = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = = >
// constants
const int kNumLeds = 3;             // three LEDs
const int kLedOn = 0;               // LED on if 0

// LEDs
DigitalOut led_0(LED_RED);
DigitalOut led_1(LED_GREEN);
DigitalOut led_2(LED_BLUE);

// ID of led that should blink; *volatile* because changed by interrupt
volatile int led_blink_id = 0;

// counters
int num_turned_on_0 = 0;            // count number of times red LED turned on
int num_turned_on_1 = 0;            // count number of times green LED turned on
int num_turned_on_2 = 0;            // count number of times blue LED turned on



/**
 * Toggle / Switch / Blink the state of the LED.
 * Count the number of times the LED was turned ON.
 * We have quite some duplicate code here; this is not ideal and could be solved
 * using more 'advanced' concepts such as arrays and enums. 
 * However, this is outside the scope of this course for now.
 */
void ToggleLed()
{
    switch (led_blink_id) {
        case 0: {
            // LED 0 to toggle and count:
            led_0 = not led_0;
            if (led_0 == kLedOn) {
                num_turned_on_0++;
            }
            
            // LEDs to turn off:
            led_1 = not kLedOn;
            led_2 = not kLedOn;
            
            break;
        }
        case 1: {
            // LED 1 to toggle and count:
            led_1 = not led_1;
            if (led_1 == kLedOn) {
                num_turned_on_1++;
            }
            
            // LEDs to turn off:
            led_0 = not kLedOn;
            led_2 = not kLedOn;
            
            break;
        }
        case 2: {
            // LED 2 to toggle and count:
            led_2 = not led_2;
            if (led_2 == kLedOn) {
                num_turned_on_2++;
            }
            
            // LEDs to turn off:
            led_0 = not kLedOn;
            led_1 = not kLedOn;
            
            break;
        }
    }
}

/**
 * Print the number of times each LED was turned on through serial communication
 */
void PrintSerial()
{
    pc.printf("*Status*\r\n\tn_r = %d\r\n\tn_g = %d\r\n\tn_b = %d\r\n\r\n",
        num_turned_on_0, num_turned_on_1, num_turned_on_2);
}

/**
 * Switch the led id that blinks 
 * led_blink_id goes from 0 -> 1 -> 2 -> 0 -> ...
 * @ensure led_blink_id = ++led_blink_id % kNumStates
 */
void SwitchLedColor() {
    led_blink_id++;
    if (led_blink_id>=kNumLeds) {
        // could also use modulo ('%') operator
        led_blink_id = 0;
    } 
}

/**
 * Main loop.
 */
int main()
{
    // Serial comm baud rate
    pc.baud(SERIAL_BAUD);
    pc.printf("\r\n**RESET**\r\n");
    
    // Turn off all LEDs initially
    led_0 = not kLedOn;
    led_1 = not kLedOn;
    led_2 = not kLedOn;
    
    // Create ticker and attach LED toggle function
    Ticker tick_toggle_led;
    tick_toggle_led.attach(&ToggleLed,kTimeLedToggle);
    
    // Create ticker and attach Print function
    Ticker tick_print_serial;
    tick_print_serial.attach(&PrintSerial,kTimePrintSerial);
    
    // Create interrupt and attach switch function
    InterruptIn sw2(SW2);
    sw2.fall(&SwitchLedColor);
    
    while (true);
}