Updated 6640_test to include trajectory tracking.