Robot controller, robot system, robot control method

Patent metadata

Field	Value
Publication number	US-9517562-B2
Application number	US-201514672668-A
Country	US
Kind code	B2
Filing date	Mar 30, 2015
Priority date	Jan 17, 2012
Publication date	Dec 13, 2016
Grant date	Dec 13, 2016

Abstract

A robot controller includes a force control unit that outputs a correction value of a target track of a robot based on a detected sensor value acquired from a force sensor, a target value output unit that obtains a target value by performing correction processing on the target track based on the correction value and outputs the obtained target value, and a robot control unit that performs feedback control of the robot based on the target value. The force control unit includes an impedance processor that obtains a solution of a differential equation in force control as the correction value before the conversion processing, and a nonlinear convertor that obtains the correction value after the conversion processing by performing nonlinear conversion processing on the correction value before the conversion processing acquired from the impedance processor and outputs the obtained correction value after the conversion processing.

First claim

What is claimed is:

1. A robot controller comprising:
a force control unit including a processor and a nonlinear convertor, the force control unit receiving a detected sensor value from a force sensor and outputting a correction value of a target track of a robot based on the detected sensor value, wherein:
the processor includes a digital filter that performs a digital filter processing on the detected sensor value, the digital filter includes a digital computation part, a digital filter coefficient output part, and a digital filter stability determination part, and
the nonlinear convertor performs nonlinear conversion processing on an output of the digital filter and outputs the correction value of the target track of the robot.

2. The robot controller according to claim 1 , wherein
when a virtual displacement with respect to the robot corresponding to the correction value is a first displacement, an amount of displacement change with respect to an external force is a first amount of displacement change,
when the virtual displacement with respect to the robot corresponding to the correction value is a second displacement different from the first displacement, the amount of displacement change with respect to the external force is a second amount of displacement change, and
the nonlinear convertor performs the nonlinear conversion processing such that the first amount of displacement change is larger than the second amount of displacement change when the virtual displacement is the first displacement which is larger than the second displacement.

3. The robot controller according to claim 1 , wherein
when a virtual displacement with respect to the robot corresponding to the correction value is a first displacement, an amount of displacement change with respect to an external force is a first amount of displacement change, and
when the virtual displacement with respect to the robot corresponding to the correction value is a second displacement different from the first displacement, an amount of displacement change with respect to the external force is a second amount of displacement change, and
the nonlinear convertor performs the nonlinear conversion processing such that the first amount of displacement change is smaller than the second amount of displacement change when the virtual displacement is the first displacement which is larger than the second displacement.

4. The robot controller according to claim 1 , wherein the force control unit performs a first force control when a direction of a first virtual displacement with respect to the robot corresponding to the correction value of the target track of the robot is a first direction, and performs a second force control different from the first force control when the direction of a second virtual displacement is a second direction opposite to the first direction.

5. A robot controlled by the robot controller according to claim 1 .

6. The robot controller according to claim 1 , wherein
the processor is configured to control the robot by a control signal based on Y n , where Y n is an output value of the digital filter, and the processor generates the Y n by:
Y n =C 0 F+C 1 Y n−1 +C 2 Y n−2

where F is a measurement of at least one of the force sensor and the correction value and each of C 0 , C 1 , and C 2 is a coefficient.

7. A robot controller comprising:
a force control unit including a processor and a nonlinear convertor, the force control unit receiving a detected sensor value from a force sensor and outputting a correction value of a target track of a robot based on the detected sensor value, wherein;
the nonlinear convertor performs nonlinear conversion processing on the detected sensor value acquired from the force sensor; and
the processor includes a digital filter that performs a digital filter processing on the detected sensor value after nonlinear conversion processing, the digital filter includes a digital computation part, a digital filter coefficient output part, and a digital filter stability determination part, and the digital filter outputs the correction value based on the detected sensor value after the nonlinear conversion processing.

8. The robot controller according to claim 7 , wherein
when a virtual displacement with respect to the robot corresponding to the correction value is a first displacement, an amount of displacement change with respect to an external force is a first amount of displacement change,
when the virtual displacement with respect to the robot corresponding to the correction value of the target track of the robot is a second displacement different from the first displacement, the amount of displacement change with respect to the external force is a second amount of displacement change, and
the nonlinear convertor performs the nonlinear conversion processing such that the first amount of displacement change is larger than the second amount of displacement change when the virtual displacement is the first displacement which is larger than the second displacement.

9. The robot controller according to claim 7 , wherein
when a virtual displacement with respect to the robot corresponding to the correction value is a first displacement, an amount of displacement change with respect to an external force is a first amount of displacement change, and
when the virtual displacement with respect to the robot corresponding to the correction value is a second displacement different from the first displacement, an amount of displacement change with respect to the external force is a second amount of displacement change, and
the nonlinear convertor performs the nonlinear conversion processing such that the first amount of displacement change is smaller than the second amount of displacement change when the virtual displacement is the first displacement which is larger than the second displacement.

10. The robot controller according to claim 7 , wherein the force control unit performs a first force control when a direction of a first virtual displacement with respect to the robot corresponding to the correction value of the target track of the robot is a first direction, and performs a second force control different from the first force control when the direction of a second virtual displacement is a second direction opposite to the first direction.

11. A robot controlled by the robot controller according to claim 7 .

12. The robot controller according to claim 7 , wherein
the processor is configured to control the robot by a control signal based on Y n , where Y n is an output value of the digital filter, and the processor generates the Y n by:
Y n =C 0 F+C 1 Y n−1 +C 2 Y n−2

where F is a measurement of at least one of the force sensor and the correction value and each of C 0 , C 1 , and C 2 is a coefficient.

Assignees

• Seiko Epson Corp

Inventors

• Inazumi Mitsuhiro

Classifications

• G05B19/4086

  Coordinate conversions; Other special calculations · CPC title

• B25J9/1694 Primary

  characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion · CPC title

• G05B2219/39343

  Force based impedance control · CPC title

• B25J9/1648

  non-linear control combined or not with linear control · CPC title

• B25J9/1633 Primary

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