Working PID controller with return to home :D

Dependencies:   Encoder HIDScope MODSERIAL QEI mbed

Fork of Motor4_SETPOINTMOTORPD by Yorick Fredrix