Home position met PI control

Dependencies:   Encoder HIDScope mbed