Applied force control for robots

Patent metadata

Field	Value
Publication number	US-12290929-B2
Application number	US-202318123858-A
Country	US
Kind code	B2
Filing date	Mar 20, 2023
Priority date	Mar 20, 2023
Publication date	May 6, 2025
Grant date	May 6, 2025

Abstract

A method includes using at least one processor to detect that a tool coupled to an end effector of a robot having multiple joints is contacting a surface. The robot includes multiple joint motors configured to control multiple motions of the multiple joints. One or more control systems are configured to control each of the joint motors in a joint position mode. The method also includes identifying, via the at least one processor, a first joint of the multiple joints in response to detecting that the tool is contacting the surface. The method also includes sending, via the at least one processor, a command to at least one of the one or more control systems associated with a first joint motor of the multiple joint motors that corresponds to the first joint. The command is configured to cause the at least one of the one or more control systems to operate in a torque mode. The method also includes sending, via the at least one processor, a joint torque value to the at least one of the one or more control systems. The at least one of the one or more control systems is configured to cause the first joint to apply the joint torque value via the first joint motor.

First claim

What is claimed is:

1. A method, comprising:
detecting, via at least one processor, that a tool coupled to an end effector of a robot comprising a plurality of joints is contacting a surface, wherein the robot comprises a plurality of joint motors configured to control a plurality of motions of the plurality of joints, and wherein one or more control systems are configured to control each of the plurality of joint motors in a joint position mode;
identifying, via the at least one processor, a first joint of the plurality of joints in response to detecting that the tool is contacting the surface;
sending, via the at least one processor, a command to at least one of the one or more control systems associated with a first joint motor of the plurality of joint motors that corresponds to the first joint, wherein the command is configured to cause the at least one of the one or more control systems to operate in a torque mode; and
sending, via the at least one processor, a joint torque value to the at least one of the one or more control systems, wherein the at least one of the one or more control systems is configured to cause the first joint to apply the joint torque value via the first joint motor.

2. The method of claim 1 , wherein the one or more control systems are configured to control each of the plurality of joint motors in the joint position mode by adjusting at least one operation of at least one of the plurality of joint motors to cause at least one joint of the plurality of joints to move in accordance to a path.

3. The method of claim 1 , wherein the torque mode comprises controlling a torque value applied by at least one of the plurality of joints via at least one of the plurality of joint motors.

4. The method of claim 1 , wherein the at least one of the one or more control systems are configured to cause the first joint to apply the joint torque value via the first joint motor by adjusting one or more electrical waveforms provided to the first joint motor via a power electronic system.

5. The method of claim 1 , wherein the tool of the robot is determined to be contacting the surface based on a position of a tool center point frame of the end effector relative to a location of the surface, sensor data received from one or more sensors coupled to the tool, or both.

6. The method of claim 5 , wherein the one or more sensors comprise a force sensor, an optical sensor, an image sensor, or any combination thereof.

7. The method of claim 1 , wherein identifying the first joint of the plurality of joints comprises selecting one of the plurality of joints positioned closest to a base reference frame associated with the robot, selecting an additional one of the plurality of joints corresponding to a link of the robot being closest to parallel to the surface as compared to other links of the robot, or selecting a predefined one of the plurality of joints.

8. A system, comprising:
a robotic system comprising a plurality of joints and a plurality of links, wherein at least a portion of the plurality of links is coupled to at least a portion of the plurality of the joints;
a drive system configured to control a plurality of joint motors configured to adjust a plurality of positions, a plurality of applied forces, or both of the plurality of joints;
a control system configured to:
detect that a tool coupled to an end effector of the robotic system is contacting a surface, wherein the control system is configured to control each of the plurality of joint motors in a joint position mode via the drive system;
identify a first joint of the plurality of joints in response to detecting that the tool is contacting the surface;
send a command to the drive system, wherein the command is configured to cause the drive system to operate a first joint motor of the plurality of joint motors in a torque mode; and
send a joint torque value to the drive system, wherein the drive system is configured to cause the first joint to apply the joint torque value via the first joint motor.

9. The system of claim 8 , wherein the control system is part of the drive system.

10. The system of claim 8 , wherein the control system is configured to:
identify a second joint of the plurality of joints in response to detecting that the tool is contacting the surface;
send an additional command to the drive system, wherein the additional command is configured to cause the drive system to operate a second joint motor of the plurality of joint motors in the torque mode; and
send an additional joint torque value to the drive system, wherein the drive system is configured to cause the second joint to apply the additional joint torque value via the second joint motor.

11. The system of claim 8 , wherein the control system is configured to communicate with the drive system via a network.

12. The system of claim 8 , comprising one or more sensors configured to detect that the tool is contacting the surface, determine a torque provided at least one of the plurality of joints, determine a position of at least another one of the plurality of joints, or any combination thereof.

13. The system of claim 8 , wherein the tool is configured to apply a treatment to the surface.

14. The system of claim 13 , wherein the treatment comprises grinding, sanding, polishing, painting, or any combination thereof.

15. The system of claim 8 , wherein the control system is configured to:
identify a second joint of the plurality of joints after identifying the first joint;
send an additional command to the drive system, wherein the additional command is configured to cause the drive system to operate a second joint motor of the plurality of joint motors in the torque mode and operate the first joint motor in the joint position mode; and
send an additional joint torque value to the drive system, wherein the drive system is configured to cause the second joint to apply the additional joint torque value via the second joint motor.

16. One or more non-transitory, computer readable media containing instructions that, when executed by one or more processors, cause the one or more processors to perform one or more operations comprising:
detecting that a tool coupled to an end effector of a robot comprising a plurality of joints is contacting a surface, wherein the robot comprises a plurality of joint motors configured to control a plurality of motions of the plurality of joints, and wherein one or more control systems are configured to control each of the plurality of joint motors in a joint position mode;
identifying a first joint of the plurality of joints in response to detecting that the tool is contacting the surface;
sending a command to at least one of the one or more control systems associated with a first joint motor of the plurality of joint motors that corresponds to the first joint, wherein the command is configured to cause the at least one of the one or more control systems to operate in a torque mode; and
sending a joint torque value to the at least one of the one or more control systems, wherein the at least one of the one or more control systems is configured to cause the first joint to apply the joint torque value via the first joint motor.

17. The one or more non-transitory, computer readable media of claim 16 , wherein the instructions cause the one or more processors to perform the operations comprises estimating a contact force between the tool and the surface.

18. The one or more non-transitory, computer readable media of claim 17 , wherein the instructions cause the one or more processors t

Assignees

• Rockwell Automation Tech Inc

Inventors

• Hoffman Jonathan D
• Guru Arun K
• Miklosovic Robert J
• Kalolia Maulik
• Da Silva Aderiano M
• Yang Jasper Hao

Classifications

• B25J9/1664 Primary

  characterised by motion, path, trajectory planning · CPC title

• B25J9/106

  with articulated links · CPC title

• B25J9/1633 Primary

  compliant, force, torque control, e.g. combined with position control · CPC title