Add testing for motion to trajectory