Clean up #1 - Launch files
Clean up #2 - Matlab, package.xml and root
Clean up #3 - Python scripts
Clean up #4 - CPP code