PID added limits and stoping on cross