Working smart teleop using the hydra to control markers in rviz