*i2dZddlmZGddeZdS)z9Leader-follower teleoperation using YAM teaching handles.)TeleopInterfaceceZdZdZedefdZedefdZd dZ d dZ d dZ defd Z edefd Z dS) YAMInterfacez.Follower arms mirror leader arms in real time.returncdS)Nleaderselfs 0/home/robot-lab/raiden_cmu/raiden/control/yam.pynamezYAMInterface.name sxcdS)NTr r s r uses_leaderszYAMInterface.uses_leaders strNcdSNr r robot_controllers r setupzYAMInterface.setups rc.|dSr)start_teleoperationrs r startzYAMInterface.starts,,.....rc.|dSr)stop_teleoperationrs r stopzYAMInterface.stops++-----rc.|duSr)check_button_pressrs r pollzYAMInterface.polls2244D@@rc dS)Na[ ============================================================ BIMANUAL TELEOPERATION ACTIVE ============================================================ Press the button on any leader arm to return ALL arms to home Press Ctrl+C for EMERGENCY STOP (stops all motion immediately) ============================================================ r r s r bannerzYAMInterface.banner"s   r)rN)__name__ __module__ __qualname____doc__propertystrr boolrrrrrr r rr rrs88 cXdX    ////....AAAAA    X   rrN)r$raiden.control.baserrr rr r)sQ??//////% % % % % ?% % % % % r