Make sure you're trajectory is pointing where where you want to go