File size: 1,830 Bytes
12ea01b | 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 | from general_motion_retargeting.optitrack_vendor.NatNetClient import setup_optitrack
from general_motion_retargeting import GeneralMotionRetargeting as GMR
from general_motion_retargeting import RobotMotionViewer
import threading
import argparse
def main(args):
# Check if firewall is disabled on this machine
print("Make sure to disable firewall on both machines:")
print("On OptiTrack computer: Disable Windows Firewall")
print("On this computer: sudo ufw disable")
client = setup_optitrack(
server_address=args.server_ip,
client_address=args.client_ip,
use_multicast=args.use_multicast,
)
# start a thread to client.run()
thread = threading.Thread(target=client.run)
thread.start()
if not client:
print("Failed to setup OptiTrack client")
exit(1)
print(f"OptiTrack client connected: {client.connected()}")
print("Starting motion retargeting...")
retarget = GMR(
src_human="fbx",
tgt_robot=args.robot,
actual_human_height=1.6,
)
viewer = RobotMotionViewer(robot_type="unitree_g1")
while True:
frame = client.get_frame()
frame_number = client.get_frame_number()
qpos = retarget.retarget(frame)
viewer.step(
root_pos=qpos[:3],
root_rot=qpos[3:7],
dof_pos=qpos[7:],
rate_limit=False,
)
if __name__ == "__main__":
parser = argparse.ArgumentParser()
parser.add_argument("--server_ip", type=str, default="192.168.200.160")
parser.add_argument("--client_ip", type=str, default="192.168.200.117")
parser.add_argument("--use_multicast", type=bool, default=False)
parser.add_argument("--robot", type=str, default="unitree_g1")
args = parser.parse_args()
main(args)
|