Merge pull request #1 from RoboGroup3/master

Updates
src/path_navigation.cpp
sometimes it shows in rviz
Now it is published to visualization_marker but still not show up in rviz
Merge pull request #4 from qiqiapple/master

Now indeed published but still not visualized
src/path_navigation.cpp
Merge pull request #5 from valeRB/master

Added path_planning_new  node
Changes from robot
Newest adds from robot
Adds how far to drive and to do turns
Changed statement
now visualized in rviz
Merge pull request #6 from qiqiapple/master

now visualized in rviz
some updates
Merge pull request #7 from qiqiapple/master

some updates
Changes sign on rotation
New updates from the robot
Small changes
Adds if statements in followpath
Working path navigation