US5469531A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Process for hybrid position/force control for a robot manipulator
Assignee: Office National d'Études et de Recherches Aérospatiales
•
Filing: 1994-01-19
•
Granted: 1995-11-21
•
Expires: 2014-01-19
Abstract
Abstract The invention relates to the control of robot manipulators comprised of a macro-manipulator combined with a micro-manipulator with a load grasping device. The control is accomplished from set-point values of force (F d ) and set-point values of position (χ d ), which are compared to real values (F m , χ m ) in order to produce increments of displacement (Δx, Δy, Δz, Δθx, Δθy, Δθz) intended for the load grasping device. Added to values (χ m ) representing the actual position, these increments yield new set-point values of position (χ' d ) of the load grasping device. These set-point values are distributed (at 29) between the macro-manipulator and the micro-manipulator, taking into account the deformation (ΔX ) and the mobility that are acceptable for the macro-manipulator. Specific application: robot manipulator of large size and high capacity for outdoor use, especially on construction sites.
Inventors
- 👤 Serge Faure
- 👤 Alain Gaillet
- 👤 Regis Lefebvre
- 👤 Claude Reboulet
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-11-08 06:56
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/10; B25J9/1005; B25J9/1015; B25J17/00; B25J17/02; B25J17/0208; B25J17/0216; B25J9/16; B25J9/1628; B25J9/1648
Claims Analysis
Total Claims: 12
Claim 1
Independent Claim
440 words
A process for hybrid position/force control for a robot manipulator for grasping a load (4), of the type which comprises a macro-manipulator (1) connected to a micro-manipulator (2) with a load grasping device (3), the process comprising: inputting N set-point values of force (F d ) of contact of the load grasping device (3) or of the load (4) with the environment, and (6-N) first set-point values of position (χ d ) of the load grasping device (3), which correspond respectively to the six degrees of freedom of space; comparing the set-point values of force and the first set-point values of position (F d , χ d ) (at 30, 32) respectively to real force values and real position values (F m , χ m ) input by respective sensors of force (28) and of position, to produce values of deviation; translating the values of deviation (at 31) into increments of displacement (Δx, Δy, Δz, Δθx, Δθy, Δθz) for controlling the load grasping device (3); adding the increments of displacement (at 33) to the real position values (χ m ) which represent an actual position, in order to constitute second set-point values of position (X' d ) of the load grasping device (3); adjusting the second set-point values of position (χ' d ) of the load grasping device (3), by taking into account (at 29) real micro-manipulator position (Xp) of the macro-manipulator (1) and a macro-manipulator deformation (ΔX ) to yield third set-point values of position (X d c ); transforming the third set-point values of position (X d c ) by a micro-manipulator manipulator transformer of coordinates (34) into articular micro-manipulator set-point values (a d ) for controlling micro-manipulator automatic controls of micro-manipulator actuating gears (24) of the micro-manipulator (2); controlling the micro-manipulator actuating gears using the articular micro-manipulator set-point values (a d ); directing to the macro-manipulator virtual set-point values of position (X* p D), taking into account the deformation (ΔX ) and an initial position (X o p ) of the macro-manipulator (1); selectively distributing the virtual set-point values (X* p D) (at 37) between realizable set-point values of position (X* p D) directed to the macro-manipulator (1) and non-realizable set-point values that are not realizable by the macro-manipulator (1) and which are directed to the micro-manipulator (2); transforming the virtual set-point values of position (X* p d) by a macro-manipulator transformer of coordinates (35) into articular macro-manipulator set-point values (A d ) for controlling macro-manipulator automatic controls of macro-manipulator actuating gears (19, 20, 21, 22, 26, 27) of the macro-manipulator (1); and controlling the macro-manipulator actuating gears using the articular macro-manipulator set-point values (A d ).
Claim 2
Dependent Claim
440 words
A process for hybrid position/force control for a robot manipulator for grasping a load (4), of the type which comprises a macro-manipulator (1) connected to a micro-manipulator (2) with a load grasping device (3), the process comprising: inputting N set-point values of force (F d ) of contact of the load grasping device (3) or of the load (4) with the environment, and (6-N) first set-point values of position (χ d ) of the load grasping device (3), which correspond respectively to the six degrees of freedom of space; comparing the set-point values of force and the first set-point values of position (F d , χ d ) (at 30, 32) respectively to real force values and real position values (F m , χ m ) input by respective sensors of force (28) and of position, to produce values of deviation; translating the values of deviation (at 31) into increments of displacement (Δx, Δy, Δz, Δθx, Δθy, Δθz) for controlling the load grasping device (3); adding the increments of displacement (at 33) to the real position values (χ m ) which represent an actual position, in order to constitute second set-point values of position (X' d ) of the load grasping device (3); adjusting the second set-point values of position (χ' d ) of the load grasping device (3), by taking into account (at 29) real micro-manipulator position (Xp) of the macro-manipulator (1) and a macro-manipulator deformation (ΔX ) to yield third set-point values of position (X d c ); transforming the third set-point values of position (X d c ) by a micro-manipulator manipulator transformer of coordinates (34) into articular micro-manipulator set-point values (a d ) for controlling micro-manipulator automatic controls of micro-manipulator actuating gears (24) of the micro-manipulator (2); controlling the micro-manipulator actuating gears using the articular micro-manipulator set-point values (a d ); directing to the macro-manipulator virtual set-point values of position (X* p D), taking into account the deformation (ΔX ) and an initial position (X o p ) of the macro-manipulator (1); selectively distributing the virtual set-point values (X* p D) (at 37) between realizable set-point values of position (X* p D) directed to the macro-manipulator (1) and non-realizable set-point values that are not realizable by the macro-manipulator (1) and which are directed to the micro-manipulator (2); transforming the virtual set-point values of position (X* p d) by a macro-manipulator transformer of coordinates (35) into articular macro-manipulator set-point values (A d ) for controlling macro-manipulator automatic controls of macro-manipulator actuating gears (19, 20, 21, 22, 26, 27) of the macro-manipulator (1); and controlling the macro-manipulator actuating gears using the articular macro-manipulator set-point values (A d ).
Claim 3
Dependent Claim
50 words
The process according to claim 1, wherein the set-point values (X o p ) directed to the macro-manipulator (1) are established in such a way that the macro-manipulator (1) occupies a constant position in space, in the course of a sequence of grasping or letting go of a load (4).
Claim 4
Dependent Claim
88 words
The process according to claim 2, wherein the set-point values of position (x d c l ) assigned to the micro-manipulator (2), result from a subtraction (at 38), from the set-point values of position (χ' d ) of the load grasping device (3), of a magnitude (Xp) which represents the real position of the macro-manipulator (1), which magnitude (Xp) itself is estimated from the position (X* p d) of the macro-manipulator (1), which is assumed to be rigid, and is corrected (at 39) by the deformation (ΔX ).
Claim 5
Dependent Claim
127 words
The process according to claim 3, including application to a robot manipulator of large size and high capacity for outdoor use, with a motorized carrier (1), constituted by a swivelling mast (7) and an unfolding arm (11) in several elements (12, 13, 14, 15) articulated to one another, and which has, at the end of the unfolding arm (11), a motorized compensator (2) equipped with a grasping device mount fox detecting forces in active compliance, in which the carrier (1) constitutes the macro-manipulator and the compensator (2) constitutes the micro-manipulator, the process ensures the distribution of forms of mobility between the carrier (1) and the compensator (2), while controlling the forces of contact in the course of operations of grasping and letting go of a load (4).
Claim 6
Dependent Claim
136 words
Process for hybrid position/force control for a robot manipulator according to claim 2, characterized by its application to a robot manipulator of large size and high capacity for outdoor use, with a motorized carrier (1), constituted by a swivelling mast (7) and an unfolding arm (11) in several elements (12, 13, 14, 15) articulated to one another, and which has, at the end of the unfolding arm (11), a motorized compensator (2) equipped with a grasping device mount for detecting forces in active compliance, in which the carrier (1) constitutes the macro-manipulator and the compensator (2) constitutes the micro-manipulator, the process ensures the distribution of forms of mobility between the carrier (1) and the compensator (2), while controlling the forces of contact in the course of operations of grasping and letting go of a load (4).
Claim 7
Dependent Claim
67 words
The process according to claim 1, wherein the set-point values (X o p l ) directed to the macro-manipulator (1) are established in such a way that the macro-manipulator (1) occupies an adjustable position, in the course of a sequence of grasping or letting go of a load (4), so as to reduce the deviation between the real position and the median position of the micro-manipulator (2).
Claim 8
Dependent Claim
89 words
The process according to claim 6, wherein the set point values of position (x d c ) , assigned to the micro-manipulator (2), result from a subtraction (at 38), from the set-point values of position (χ' d ) of the load grasping device (3), of a magnitude (Xp) which represents the real position of the macro-manipulator (1), which magnitude (Xp) itself is estimated from the position (X* p d) of the macro-manipulator (1), which is assumed to be rigid, and is corrected (at 39) by the deformation (ΔX )
Claim 9
Dependent Claim
127 words
The process according to claim 7, including application to a robot manipulator of large size and high capacity for outdoor use, with a motorized carrier (1), constituted by a swivelling mast (7) and an unfolding arm (11) in several elements (12, 13, 14, 15) articulated to one another, and which has, at the end of the unfolding arm (11), a motorized compensator (2) equipped with a grasping device mount for detecting forces in active compliance, in which the carrier (1) constitutes the macro-manipulator and the compensator (2) constitutes the micro-manipulator, the process ensures the distribution of forms of mobility between the carrier (1) and the compensator (2), while controlling the forces of contact in the course of operations of grasping and letting go of a load (4).
Claim 10
Dependent Claim
127 words
The process according to claim 6, including application to a robot manipulator of large size and high capacity for outdoor use, with a motorized carrier (1), constituted by a swivelling mast (7) and an unfolding arm (11) in several elements (12, 13, 14, 15) articulated to one another, and which has, at the end of the unfolding arm (11), a motorized compensator (2) equipped with a grasping device mount for detecting forces in active compliance, in which the carrier (1) constitutes the macro-manipulator and the compensator (2) constitutes the micro-manipulator, the process ensures the distribution of forms of mobility between the carrier (1) and the compensator (2), while controlling the forces of contact in the course of operations of grasping and letting go of a load (4).
Claim 11
Dependent Claim
88 words
The process according to claim 1, wherein the set-point values of position (x d c l ) assigned to the micro-manipulator (2), result from a subtraction (at 38), from the set-point values of position (x' d ) of the load grasping device (3), of a magnitude (Xp) which represents the real position of the macro-manipulator (1), which magnitude (Xp) itself is estimated from the position (X* p d) of the macro-manipulator (1), which is assumed to be rigid, and is corrected (at 39) by the deformation (ΔX ).
Claim 12
Dependent Claim
127 words
The process according to claim 1, including application to a robot manipulator of large size and high capacity for outdoor use, with a motorized carrier (1), constituted by a swivelling mast (7) and an unfolding arm (11) in several elements (12, 13, 14, 15) articulated to one another, and which has, at the end of the unfolding arm (11), a motorized compensator (2) equipped with a grasping device mount for detecting forces in active compliance, in which the carrier (1) constitutes the macro-manipulator and the compensator (2) constitutes the micro-manipulator, the process ensures the distribution of forms of mobility between the carrier (1) and the compensator (2), while controlling the forces of contact in the course of operations of grasping and letting go of a load (4).
References Cited (Backward Citations)
US4621332A
Cited
DE3810691A1
Cited
US5129044A
Cited
US5038089A
Cited
US5047916A
Cited
US4974210A
Cited
US5217344A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1998-11-20 | 1999-05-22 | 1999-11-21 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2002-11-20 | 2003-05-22 | 2003-11-21 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2006-11-20 | 2007-05-22 | 2007-11-21 | $7700.00 | Window Closed / Lapsed |