Add simulation of reached WP message
Add simulation of reached WP message

Add a list of cone WP indexes & log
Improve last/next item logging
Add simulated reached WP listener

Example use:
rostopic pub /simulate_reached_wp std_msgs/Int16 1 -1s

ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan,ProgrammingRobotsStudyGroup/robo_magellan