1st implementation of motor controller
changed implementation of motor controller
Motor controller implementation.
Proper motor controller implementation.
Minor adjustments to motor controller algorithm.
improved axeleration handling in motor controller
Improved motor-controller: - taking current speed into account when choosing nextPower; - initialization of motor power when already moving