# US 2010/0168915 A1 · Method and apparatus for calibrating position and attitude of arm tip of robot

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2010/0168915 A1
- Document ID: US20100168915A1
- Status: Published application
- Kind: A1
- Application number: 12/654,412
- Filed: 2009-12-18
- Published: 2010-07-01
- Earliest claimed: 2008-12-18
- Assignees: Denso Wave Incorporated
- Inventors: Naoya Kagawa; Tetsuya Sato
- Web page: https://patentgrep.com/patent/US20100168915A1

## CPC

- B25J 9/1692: {Calibration of manipulator}
- G05B 2219/39026: Calibration of manipulator while tool is mounted
- G05B 2219/40527: Modeling, identification of link parameters
- G05B 2219/40557: Tracking a tool, compute 3-D position relative to camera
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A calibrating technique is provided for the position/attitude or only the position of an arm tip of a robot, such as an articulated type of robot. At plural positions, respective n pieces of errors (Δφn, wherein n is a positive integer larger than a value obtained by dividing the number of unknown parameters by 6 or 3) are calculated. Each error is a difference between a position of the arm tip measured and a position commanded by control. An inter-error difference (Δεy (1≦y≦n−1)) between a reference error (Δφm (1≦m≦n)) arbitrarily selected from the n-piece errors (Δφn) and other errors (Δφx (x≦n, except for m)) other than the reference error (Δφm) is calculated. A parameter, which is a basis for calculating the inter-error differences (Δεy), is made to converge until a sum of absolute values of the inter-error differences (Δεy) becomes within a given threshold (ε0 (ε0>0)).

## Claims

### Claim 1

A method of positionally calibrating a tip of an arm of a manipulated type of robot, the arm tip being defined as a tip of a tool held by the arm, comprising steps of:
controlling the arm so that the arm tip is moved to a plurality of positions (n: positive integer more than 1);
calculating, at the plurality of positions, n pieces of errors (Δφ: Δφ1, Δφ2, . . . , Δφn, wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 3), respectively, each of the errors being an error between a position of the arm tip measured by a measurement device and a position commanded by control at each of the plurality of positions;
calculating an inter-error difference (Δεy (1≦y≦n−1)) between a given reference error (Δφm(1≦m≦n)) arbitrarily selected from the n-piece errors (Δφ) and other errors (Δφx (x≦n, except for m)) left other than the given reference error (Δφm) among the n-piece errors; and
making a parameter, which is a basis for calculating the inter-error differences (Δεy), converge until a sum of absolute values of the respective inter-error differences (Δεy) becomes equal to or less than a given threshold (ε0 (ε0>0)),
wherein the converging step further includes steps of:
calculating a Jacobian determinant (J) for parameter matrices (q, θ), wherein (q) is a matrix of the parameters and θ is a matrix of angles of respective axes of the arm,
calculating an error matrix (Δq) of the parameter matrix q based on a product of an inter-error difference (Δεy) and a stimulated inverse matrix of the Jacobian determinant (J),
updating the parameter matrix (q) by adding the error matrix (Δq) to the parameter matrix (q), and
re-calculating the position of the arm tip depending on the updated parameter matrix (q), so that the parameter matrix (q) is made to converge so as to calibrate the position of the arm tip.

### Claim 2 (depends on 1)

The method of claim 1, wherein
the given reference error (Δφm) is composed of a plurality of reference errors which are set at a plurality of positions among the positions (n),
the inter-error differences (Δεy), the Jacobian dominant J, and the error matrix (Δq) are calculated as for each of the plurality of reference errors, and
the parameter which is a basis for calculating each of the inter-error differences (Δεy) is made to converge until a sum of absolute values of the respective inter-error differences (Δεy) at the difference reference errors (Δφm) becomes equal to or less than a given threshold (ε1 (Δ1>0)),

### Claim 3 (depends on 2)

The method of claim 2, wherein the position of the arm tip is composed of a position and an attitude of the arm tip, and
the plurality of positions (n) is composed of a plurality of positions and attitudes (n), wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 6.

### Claim 4 (depends on 3)

The method of claim 3, wherein the inter-error difference calculating step calculates the inter-error difference (Δεy) based on the following formula:
Δ


ɛ
y
=
(
T
mea
,
x
-
T
mea
,
m
)
-
[
R
rb
mb

(
R
rb
,
x
mb
-
R
rb
,
m
mb
)
R
rb
mb

(
P
rb
,
x
mb
-
P
rb
,
m
mb
)
0
0
]
×
T
tool
fl
wherein
Tmea,x is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number x;
Tmea,m is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number m;
flTtool is a homogeneous transformation matrix representing a vector from a flange of the arm to the tip of the tool, which vector is measured by the measurement device;
mbRrb is a matrix representing a normal vector, an orientation vector, and an approach vector from the position of the measurement device to a base of the arm, the vectors being calculated;
mbRrb,x is a matrix expressed depending on the number x;
mbRrb,m is a matrix expressed depending on the number m;
mbPrb,x is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number x; and
mbPrb,m is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number m.

### Claim 5 (depends on 1)

The method of claim 1, wherein the position of the arm tip is composed of a position and an attitude of the arm tip, and
the plurality of positions (n) is composed of a plurality of positions and attitudes (n), wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 6.

### Claim 6 (depends on 5)

The method of claim 5, wherein the inter-error difference calculating step calculates the inter-error difference (Δεy) based on the following formula:
Δ


ɛ
y
=
(
T
mea
,
x
-
T
mea
,
m
)
-
[
R
rb
mb

(
R
rb
,
x
mb
-
R
rb
,
m
mb
)
R
rb
mb

(
P
rb
,
x
mb
-
P
rb
,
m
mb
)
0
0
]
×
T
tool
fl
wherein
Tmea,x is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number x;
Tmea,m is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number m;
flTtool is a homogeneous transformation matrix representing a vector from a flange of the arm to the tip of the tool, which vector is measured by the measurement device;
mbRrb is a matrix representing a normal vector, an orientation vector, and an approach vector from the position of the measurement device to a base of the arm, the vectors being calculated;
mbRrb,x is a matrix expressed depending on the number x;
mbRrb,m is a matrix expressed depending on the number m;
mbPrb,x is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number x; and
mbPrb,m is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number m.

### Claim 7

An apparatus for calibrating of a position of a tip of an arm of a manipulated type of robot, the arm tip being defined as a tip of a tool held by the arm, comprising:
arm control means for controlling the arm so that the arm tip is moved to a plurality of positions (n);
error calculating means for calculating, at the plurality of positions, n-piece errors (Δφ: Δφ1, Δφ2, . . . , Δφn wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 3), respectively, each of the errors being an error between a position of the arm tip measured by a measurement device and a position commanded by control at each of the plurality of positions;
inter-error difference calculating means for calculating an inter-error difference (Δεy (1≦y≦n−1)) between a given reference error (Δφm (1≦m≦n)) arbitrarily selected from the n-piece errors (Δφ) and other errors (Δφx (x≦n, except for m)) other than the given reference error (Δφm) among the n-piece errors; and
converging means for making a parameter, which is a basis for calibrating the inter-error differences (Δεy), converge until a sum of absolute values of the respective inter-error differences (Δεy) becomes equal to or less than a given threshold (ε0 (ε0>0)),
wherein the converging means comprises
Jacobian determinant calculating means for calculating a Jacobian determinant (J) for parameter matrices (q, θ), wherein (q) is a matrix of the parameters and θ is a matrix of angles of respective axes of the arm,
error matrix calculating means for calculating an error matrix (Δq) of the parameter matrix q based on a product of an inter-error difference (Δεy) and a stimulated inverse matrix of the Jacobian determinant (J),
updating means for updating the parameter matrix (q) by adding the error matrix (Δq) to the parameter matrix (q), and
re-calculating means for re-calculating the position of the arm tip depending on the updated parameter matrix (q), so that the parameter matrix (q) is made to converge so as to calibrate the position of the arm tip.

### Claim 8 (depends on 7)

The apparatus of claim 7, wherein
the given reference error (Δφm) is composed of a plurality of reference errors which are set at a plurality of positions among the positions (n),
the inter-error differences (Δεy), the Jacobian dominant J, and the error matrix (Δq) are calculated as for each of the plurality of reference errors, and
the parameter which is a basis for calculating each of the inter-error differences (Δεy) is made to converge until a sum of absolute values of the respective inter-error differences (Δεy) at the difference reference errors (Δφm) becomes equal to or less than a given threshold (ε1 (ε1>0)),

### Claim 9 (depends on 8)

The apparatus of claim 8, wherein
the position of the arm tip is composed of a position and an attitude of the arm tip, and
the plurality of positions (n) is composed of a plurality of positions and attitudes (n), wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 6.

### Claim 10 (depends on 9)

The apparatus of claim 9, wherein the inter-error difference calculating means calculates the inter-error difference (Δεy) based on the following formula:
Δ


ɛ
y
=
(
T
mea
,
x
-
T
mea
,
m
)
-
[
R
rb
mb

(
R
rb
,
x
mb
-
R
rb
,
m
mb
)
R
rb
mb

(
P
rb
,
x
mb
-
P
rb
,
m
mb
)
0
0
]
×
T
tool
fl
wherein
Tmea,x is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number x;
Tmea,m is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number m;
flTtool is a homogeneous transformation matrix representing a vector from a flange of the arm to the tip of the tool, which vector is measured by the measurement device;
mbRrb is a matrix representing a normal vector, an orientation vector, and an approach vector from the position of the measurement device to a base of the arm, which vectors are calculated;
mbRrb,x is a matrix expressed depending on the number x;
mbRrb,m is a matrix expressed depending on the number m;
mbPrb,x is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number x; and
mbPrb,m is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number m.

### Claim 11 (depends on 7)

The apparatus of claim 7, wherein
the position of the arm tip is composed of a position and an attitude of the arm tip, and
the plurality of positions (n) is composed of a plurality of positions and attitudes (n), wherein n is a natural number larger than a value obtained by dividing the number of unknown parameters by 6.

### Claim 12 (depends on 11)

The apparatus of claim 11, wherein the inter-error difference calculating means calculates the inter-error difference (Δεy) based on the following formula:
Δ


ɛ
y
=
(
T
mea
,
x
-
T
mea
,
m
)
-
[
R
rb
mb

(
R
rb
,
x
mb
-
R
rb
,
m
mb
)
R
rb
mb

(
P
rb
,
x
mb
-
P
rb
,
m
mb
)
0
0
]
×
T
tool
fl
wherein
Tmea,x is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number x;
Tmea,m is a homogeneous transformation matrix representing a vector from a position of the measurement device, which vector is measured by the measurement device and is expressed depending on the number m;
flTtool is a homogeneous transformation matrix representing a vector from a flange of the arm to the tip of the tool, which vector is measured by the measurement device;
mbRrb is a matrix representing a normal vector, an orientation vector, and an approach vector from the position of the measurement device to a base of the arm, which vectors are calculated;
mbRrb,x is a matrix expressed depending on the number x;
mbRrb,m is a matrix expressed depending on the number m;
mbPrb,x is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number x; and
mbPrb,m is a matrix representing a vector from the position of the measurement device to the base of the arm, which vector is calculated depending on the number m.
