PID parameter setting for velocity control added. Ultrasonic sensors are disabled.