first draft on smoothing at start and end of trajectory. needs more work, because the robot does not reach end of band atm.