Implemented DY/DX to replace angle/velocity