07-01-2021 дата публикации
Номер: US20210001490A1
Принадлежит:
Controlling a robot may be performed by calculating a desired velocity based on an operator contact force and a robot contact force, calculating a transformation matrix based on an operator pose, a robot pose, a robot trajectory, the operator contact force, and the robot contact force, calculating a least square solution to J{circumflex over (v)}based on the desired velocity, calculating a scaling factor based on a current joint position of a joint of the robot, calculating a first trajectory based on the least square solution, the scaling factor, and the transformation matrix, calculating the robot trajectory, calculating a joint command based on the robot trajectory and the robot pose, and implementing the joint command. 1. A system for controlling a robot , comprising:{'sub': h', 'r', 'f', 'h', 'r, 'an admittance controller receiving an operator contact force fand a robot contact force fand calculating a desired velocity vbased on the operator contact force fand the robot contact force f;'}{'sub': k', 'h', 'r', 'j', 'k', 'h', 'r, 'a retargeting controller receiving an operator pose R, a robot pose q, a robot trajectory q*, the operator contact force f, and the robot contact force fand calculating a transformation matrix Twhich maps a human contact state to a robot contact state based on the operator pose R, the robot pose q, the robot trajectory q*, the operator contact force f, and the robot contact force f;'}{'sub': f', 'f', 'f', 'f', 'f', 'f', 'f', 'f', 'f', 'j, 'sup': +', '+, 'a force optimization controller receiving the desired velocity vand calculating a least square solution qto J{circumflex over (v)}based on the desired velocity v, wherein Jis a Moore-Penrose pseudoinverse of J, wherein Jis a Jacobian matrix of positions of contact points with respect to joint positions and calculating a scaling factor sbased on a current joint position qof a joint of the robot;'}{'sub': f', 'f', 'j', 'f', 'f', 'j, 'a motion optimization controller receiving the least ...
Подробнее