Cleaned up collision detection class, added the buildTrajectoryRequest
function to utility in trajectory_evaluation. I will copy over the
method from ramp_planner when I work on it some more.