speed planning ovehaul
- use a fragment-based algorithm
- display position/time