Moved costmap checking to its own node, with msg
CMake changes for costmap checking stuff
Another major refactor, to use costmap check msgs
Launch includes costmap checker
Can add stop_function in __init__ now