TECS : First complete version running ride-along in SITL