Planner: these TODOs are DONE! See Block::calculate_trapezoid() and Block::max_exit_speed() implementations for details