Version 1: coming together. With PD controller but without inverse kinematics

Dependencies:   Encoder MODSERIAL mbed

Fork of motoraansturing_met_EMG by Jorick Leferink