Fix bug that wasn't setting the speed set point.
Fix bug that wasn't setting the speed set point.

hazelnusse/robot.bicycle,hazelnusse/robot.bicycle,hazelnusse/robot.bicycle,hazelnusse/robot.bicycle,hazelnusse/robot.bicycle