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

Dependencies:   Encoder MODSERIAL mbed

Fork of motoraansturing_met_EMG by Jorick Leferink

shortlog@55bff07c1058: not found in manifest