Feature/rqt dashboard

Sorry for the dirty commits. Had to rollback some stuff.