All working, but Position_x and Position_y don't start at value 0, which causes spontaneous motor action.

Dependencies:   HIDScope MODSERIAL QEI biquadFilter mbed

Fork of prog_inversekin by Gerhard Berman