Fixed an issue where a trajectory's fitness and feasibility were not being set for the Trajectory msg after being evaluated.
Increased the radius of a robot to be 0.75m.