Rewrite rqt_robot_monitor

Fixes #3, #9, #32, #33 and #71