added grid_trajectory_finder. doesn't compile right now but I think it's close