Adding logic for stopping at a floor

Fairly simple maths to work out how long it will take to move from the
decision point at the current speed to being stopped at the floor.