Add RobotStatus publishing to robot simulator node

As per subject.

Some whitespace cleaning as well, and minor typo fixes.

`RobotStatus` is currently published at the same rate as `JointStates`.