- switching from using service to message in setting robot state
- publishing whether or not the robot has reached the goal state
 removed service call to set agent state, now using mesages which allow
different nodes to run at their own frequencies. Effectively removed
pedsim_srvs dependency
 enter the commit message for your changes. Lines starting