Main control script for biorobotics project

Dependencies:   MODSERIAL QEI biquadFilter mbed