Time added to evaluation, Made changes to allow robot package to switch trajectories
-The evaluation package now adds the time it takes to move on a trajectory to the fitness value
-The planner's control cycle has been changed to 4Hz. This allows for greater accuracy when commanding the robot. Moving it up to 5Hz made the system too unstable and the reduction in error was negligible.
-The robot still overshoots the goal. We may want to add in a Stop msg to send once the planner decides the goal has been met.
-Fixed a bug where the newly generated trajectories were not being added to the index of whatever trajectory they replace in the population
Merge branch 'master' of https://github.com/sterlingm/ramp

Conflicts:
	robot/src/main.cpp