Fix a few compilation issues. Add a launchfile
Fix a few bugs