Use PID for propulsion and turning
Use PID for propulsion and turning