Interactive rviz markers for controlling Husky