Tested tele-op and auto