Split rviz marker code into seperate header file, created ppm library for loading cost maps