Code to control Mbed controller to actuate robotic fingers