Sensor-free force/torque sensing in an articulated electromechanical actuator-driven robot
A method for force or torque sensing in an electromechanical actuator-driven robot comprising one or more links, one or more joints, an end effector and a controller is provided, the method comprising: estimating a first set of load torques in one or more joints in a given configuration of the robot without external force or load applied to the end effector; identifying gravitational and frictional components in the first set of load torques; estimating a second set of load torques in the one or more joints in the given configuration of the robot with an external force or load applied to the end effector; calculating a difference between the second set of load torques and the first set of load torques, taking into account the identified gravitational and frictional components; calculating an external force or torque acting on the end effector based on the difference between the second set of load torques and the first set of load torques using a Jacobian matrix for the given configuration of the robot; and presenting the external force or torque in a Cartesian space. An apparatus for force or torque sensing in an electromechanical actuator-driven robot, the apparatus comprising at least one processor programmed to perform said method, a computer program which, when executed by at least one processor, causes the at least one processor to perform force or torque sensing in an electromechanical actuator-driven robot according to said method, and a non-transitory storage medium for storing said program are also provided. The technical result consists in improved precision of force or torque sensing on an end effector of an electromechanical actuator-driven robot in a manner which does not require using expensive force/torque sensors in robot joints.
1. An apparatus for force or torque sensing in an electromechanical actuator-driven robot comprising one or more links, one or more joints, an end effector and a controller, the apparatus comprising at least one processor programmed to:
inject a high-frequency low-amplitude (HFLA) signal to the joints to reduce the torque noise so as to improve repeatability of joint current measurements;
estimate a first set of load torques in one or more joints in a given configuration of the robot without external force or load applied to the end effector;
identify gravitational and frictional components in the first set of load torques;
estimate a second set of load torques in the one or more joints in the given configuration of the robot with an external force or load applied to the end effector;
calculate a difference between the second set of load torques and the first set of load torques, taking into account the identified gravitational and frictional components;
calculate an external force or torque acting on the end effector based on the difference between the second set of load torques and the first set of load torques using a Jacobian matrix for the given configuration of the robot;
iteratively analyze condition number values of the Jacobian matrix for the given configuration so as to detect singularities and identify operational regions in the robot workspace, where rate of preciseness of the calculations using the Jacobian matrix exceeds a threshold;
calibrating the calculated external force or torque using scale factors computed for payloads of various control weights, known a priori; and
present the external force or torque in a Cartesian space.
2. The apparatus of claim 1 , wherein the first set of load torques and the second set of load torques are estimated based on the joint current measurements.
3. The apparatus of claim 1 ,
wherein presenting the external force or torque in a Cartesian space comprises transforming the external force or torque from a joint space to the Cartesian space using the Jacobian inversion or pseudo inversion, taking into account the identified operational regions, where the rate of preciseness of the calculations using the Jacobian matrix exceeds a threshold.
4. The apparatus of claim 1 , wherein the Jacobian matrix relates the joint torques to the external force or torque acting on the end effector.
5. A non-transitory computer readable medium having stored thereon a computer program which, when executed by at least one processor, causes the at least one processor to perform force or torque sensing in an electromechanical actuator-driven robot comprising one or more links, one or more joints, an end effector and a controller, the computer program comprising processor-executable code to perform operation comprising:
injecting a high-frequency low-amplitude (HFLA) signal to the joints to reduce the torque noise so as to improve repeatability of joint current measurements;
estimating a first set of load torques in one or more joints in a given configuration of the robot without external force or load applied to the end effector;
identifying gravitational and frictional components in the first set of load torques;
estimating a second set of load torques in the one or more joints in the given configuration of the robot with an external force or load applied to the end effector;
calculating a difference between the second set of load torques and the first set of load torques, taking into account the identified gravitational and frictional components;
calculating an external force or torque acting on the end effector based on the difference between the second set of load torques and the first set of load torques using a Jacobian matrix for the given configuration of the robot;
iteratively analyzing condition number values of the Jacobian matrix for the given configuration so as to detect singularities and identify operational regions in the robot workspace, where rate of preciseness of the calculations using the Jacobian matrix exceeds a threshold;
calibrating the calculated external force or torque using scale factors computed for payloads of various control weights, known a priori; and
presenting the external force or torque in a Cartesian space.
6. The non-transitory computer readable medium having stored thereon the computer program of claim 5 , wherein the first set of load torques and the second set of load torques are estimated based on the joint current measurements.
7. The non-transitory computer readable medium having stored thereon the computer program of claim 5 ,
wherein presenting the external force or torque in a Cartesian space comprises transforming the external force or torque from a joint space to the Cartesian space using the Jacobian inversion or pseudo inversion, taking into account the identified operational regions, where the rate of preciseness of the calculations using the Jacobian matrix exceeds a threshold.
8. The non-transitory computer readable medium having stored thereon the computer program of claim 5 , wherein the Jacobian matrix relates the joint torques to the external force or torque acting on the end effector.