Groovy port of rviz_imu_plugin

This works under groovy and solves issue#9