teleop.py: Use actual robot gripper position for visualization