# US 2008/0188986 A1 · Method and System to Provide Improved Accuracies in Multi-Jointed Robots Through Kinematic Robot Model Parameters Determination

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

- Number: US 2008/0188986 A1
- Document ID: US20080188986A1
- Status: Published application
- Kind: A1
- Application number: 11/666,187
- Filed: 2005-10-25
- Published: 2008-08-07
- Earliest claimed: 2004-10-25
- Assignees: University of Dayton
- Inventors: Wally C. Hoppe
- Web page: https://patentgrep.com/patent/US20080188986A1

## CPC

- B25J 9/1692: {Calibration of manipulator}
- G05B 2219/37123: Extensible ball bar with potentiometer, lvdt
- G05B 2219/39015: With different manipulator configurations, contact known sphere, ballbar
- G05B 2219/39022: Transform between measuring and manipulator coordinate system
- G05B 2219/40527: Modeling, identification of link parameters
- 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 method and system to provide improved accuracies in multi jointed robots through kinematic robot model parameters determination are disclosed. The present invention calibrates multi-jointed robots by using the chain rule for differentiation in the Jacobian derivation for variations in calculated poses of reference points of a reference object as a function of variations in robot model parameters. The present invention also uses two such reference objects and the known distance therebetween to establish a length scale, thus avoiding the need to know one link length of the robot. In addition, the present invention makes use of iterative methods to find the optimum solution for improved accuracy of the resultant model parameters. Furthermore, the present invention provides for determination of the end joint parameters of the robot, including parameters defining the tool attachment mechanism frame, which allows for interchange of tools without subsequent calibration.

## Claims

### Claim 1

A method providing improved pose accuracies in a multi-jointed robot, said method comprising:
providing a pair of reference objects each of a known geometry and each defining a unique constraint point of unknown pose, distance between constraint points from said reference objects forming a known constraint distance;
providing an effector object on the robot, said effector object is movable by the robot in at least two axes and is configured to indicate an encounter with at least one of said reference objects;
providing a plurality of encounters of said effector object with said reference objects;
determining joint values of the robot for each of said encounters;
calculating a first pose of a first reference point from said joint values determined from at least four of said encounters with a first one of said reference objects, said first pose corresponding to a first calculated pose of said constraint point of said first reference object;
calculating a second pose of a second reference point from said joint values determined from at least four of said encounters with a second one of said reference objects, said second pose corresponding to a second calculated pose of said constraint point of said second reference object;
calculating a first difference between said first or second pose and a trial pose of said constraint point for said first or second reference object, respectively;
calculating a second difference between a calculated constraint distance and said known constraint distance, said calculated constraint distance is the distance between said trial poses of said constraint points of said pair of reference objects;
identifying kinematic model parameters of said robot model and trial poses of said constraint points of said pair of reference objects which minimize said first and second differences; and,
using said identified kinematic model parameters for improved pose accuracies in the multi-jointed robot.

### Claim 2 (depends on 1)

The method of claim 1, wherein identifying kinematic model parameters is accomplished using a chain rule for differentiation in a Jacobian derivation for variations in calculated poses of at least said first reference point as a function of variations in said robot model parameters.

### Claim 3 (depends on 1)

The method of claim 1, wherein said effector object is an offset touch probe with a spherical tip.

### Claim 4 (depends on 1)

The method of claim 1, wherein said reference points are calculated using intersections of planes that perpendicularly bisect line segments formed between points representing encounters of said effector object with said reference objects.

### Claim 5 (depends on 1)

The method of claim 1, wherein the reference objects are spheres.

### Claim 6 (depends on 1)

The method of claim 1, wherein said calculated poses and said trial poses are partial poses.

### Claim 7 (depends on 1)

The method of claim 1, wherein determining said joint values is accomplished using an external measuring device that measures pose of said effector object relative to at least one of said reference objects.

### Claim 8 (depends on 1)

The method of claim 1, wherein determining said joint values is accomplished using an external measuring device that measures pose of said effector object relative to at least one of said reference objects, said external measuring device being a linear displacement-measuring device and interpolation is used between two commanded poses to define an encounter with said at least one of said reference objects and inverse kinematics is used to find said joint values.

### Claim 9 (depends on 1)

The method of claim 1, wherein determining said joint values is accomplished using a controller of the robot.

### Claim 10 (depends on 1)

The method of claim 1, wherein identifying kinematic model parameters of said robot model which minimize said first and second differences is accomplished using best-fit values for both the model parameters and the trial poses that minimize scatter in clusters of the calculated poses of said first and second reference points about the corresponding trial poses.

### Claim 11 (depends on 1)

The method of claim 1, further comprising separating orientations and dimensions of said effector object from the robot model.

### Claim 12 (depends on 1)

The method of claim 1, further comprising separating orientations and dimensions of said effector object from the robot model by transforming the orientations and dimensions of the effector object by orientations and dimensions of a tool attachment mechanism of the robot through a matrix product and extraction of net orientations and dimensions.

### Claim 13

A system providing improved pose accuracies in a robot having a multi-jointed arm, said system comprising:
a controller configured to interpret coordinates within a three dimensional space, move the multi-jointed ann to a location within the three dimensional space that corresponds to the coordinates, and determine joint values of each joint in the multi-jointed arm;
a pair of reference objects each of a known geometry situated within the three dimensional space, each said reference objects defining a unique constraint point of unknown pose and the distance between constraint points from said reference objects forming a known constraint distance therebetween;
an effector object provided on the multi-jointed arm, said effector object is configured to indicate an encounter with at least one of said reference objects; and
a processor configured to perform parameter identification,
wherein said controller is configured to:
provide a plurality of encounters of said effector object with said reference objects, and,
wherein said controller is comprised of said processor, which processor is configured to:
determine joint values of the multi-jointed arm for each of said encounters,
calculate a first pose of a first reference point from said joint values determined from at least four of said encounters with a first one of said reference objects, said first pose corresponding to a calculated pose of the constraint point of said first reference object,
calculate a second pose of a second reference point from said joint values determined from at least four of said encounters with a second one of said reference objects, said second pose corresponding to a calculated pose of the constraint point of said second reference object,
calculate a first difference between said first or second pose and a trial pose of said constraint point for said first or second reference object, respectively,
calculate a second difference between a calculated constraint distance and said known constraint distance, said calculated constraint distance is the distance between said trial poses of said constraint points of said pair of reference objects,
identify kinematic model parameters of said robot model and said trial poses of the constraint points of said pair of reference objects, which minimize said first and second differences, and
wherein said controller is further configured to use said identified kinematic model parameters for improved pose accuracies in the multi-jointed robot.

### Claim 14 (depends on 13)

The system of claim 13, wherein said calculated poses and said trial poses are partial poses.

### Claim 15 (depends on 13)

The system of claim 13, wherein said effector object is an offset touch probe with a spherical tip.

### Claim 16 (depends on 13)

The system of claim 13, wherein said reference points are calculated using intersections of planes that perpendicularly bisect line segments formed between points representing encounters of said effector object with said reference objects.

### Claim 17 (depends on 13)

The system of claim 13, wherein said reference objects are spheres.

### Claim 18 (depends on 13)

The system of claim 13, wherein said processor is configured to identify said kinematic model parameters of said robot model which minimize said first and second differences by being configured to use best-fit values for the model parameters and the trial poses, that minimize scatter in clusters of calculated poses of said first and second reference points about the corresponding trial poses.

### Claim 19 (depends on 13)

The system of claim 13, wherein said processor is further configured to remove orientations and dimensions of said effector object from the robot model by subtracting an effector object frame representing the orientations and dimensions of said effector object from a tool attachment frame representing orientations and dimensions for a tool attachment mechanism of the multi-jointed arm.

### Claim 20 (depends on 13)

The system of claim 13, wherein said processor is further configured to separate orientations and dimensions of said effector object from the robot model by transforming the orientations and dimensions of the effector object by orientations and dimensions of a tool attachment mechanism of the robot through a matrix product and extraction of net orientations and dimensions.

### Claim 21 (depends on 13)

The system of claim 13, wherein identifying kinematic model parameters is accomplished by using a chain rule for differentiation in a Jacobian derivation for variations in calculated poses of at least said first reference point as a function of variations in said robot model parameters.

### Claim 22 (depends on 13)

The system of claim 13, wherein said processor is separate from said controller of the robot.

### Claim 23 (depends on 13)

The system of claim 13, further comprises a linear displacement device to which is attached said effector object, wherein the processor is further configured to use input from the linear displacement device to determine pose of said effector object relative to a said reference object via interpolation, said determined pose is used by the processor to determine joint values via inverse kinematic processes, and said joint values are used by the processor to identify the kinematic model parameters.

### Claim 24 (depends on 23)

The system of claim 23, wherein said processor is separate from said controller of the robot.
