Tidy up readme, add proper instructions

[JCarosella]

When the package is complete and the proper launchfiles are done we should write a proper readme with clear instructions on how to launch everything