I think we can move with speed control now, but position still kinda wrong.