6 Commits (feature/velocity_control)