fishtailing solved (publish freq local costmap)
Merge branch 'sam_Cristoff_test' of github.com:SquadCollaborativeRobotics/CollectorBotReal into sam_Cristoff_test
working p3dx