Add Run ROSJAUS bash file for running in Ubuntu with Stage, some code clean up