Fixed RobotStatePublisher errors with groovy

I downloaded underwater_simulation this evening and it was not compiling. I corrected the error with RobotStatePublisher. Can you check it?