Catkinized mst_colorstat but doesn't build yet
Fixed mst_navigation_playground catkin build, mst_colorstat is partially fixed