Working P controller

Dependencies:   Encoder HIDScope MODSERIAL QEI mbed

Fork of Motor4_SETPOINTMOTORPD by Fernon Eijkhoudt