Organizing scripts. Adding rviz plugin source code