This is the end of 3.1 and corresponds to ElevatorLab_part3.m in Matlab

Dependencies:   Motor mbed