Catkinized and commited to groovy-devel

Not able to run on `rqt_gui` yet. See commit note for the error.