fix go to origin bug, test with eagle 1 and 3, model and test car 2, car 3