US5434489A
Expired / Lapsed
US
⏱️ 0.0 years remaining
Method and system for path planning in cartesian space
Assignee: Fanuc Robotics North America Inc
•
Filing: 1993-07-30
•
Granted: 1995-07-18
•
Expires: 2013-07-30
Abstract
Abstract Method and system for trajectory or path planning to move a device such as a robot along a Cartesian path to achieve high path accuracy and ease of programming. Cascaded linear filters are utilized to perform acceleration/deceleration control in Cartesian space having six Cartesian components. Generally, six sets of such linear filters are used, three for location components and three for orientation components. Cartesian path blending is also provided. First and second path segments are planned and blended together and a corner distance is formed at a transition between the first and second path segments. A method is also provided for adjusting the corner distance. The corner distance is adjusted by corner distance variables which are independent of program speed so that the resultant Cartesian path can be maintained regardless of program speed changes.
Inventors
- 👤 Sai-Kai Cheng
- 👤 Chi-Keng Tsai
Bibliographic Details
Application Number
—
Jurisdiction
US
Data Source
google_patents
Last Synchronized
2026-10-26 18:31
CPC Classifications
B; B25; B25J; B25J9/00; B25J9/16; B25J9/1656; G; G05; G05B; G05B19/00; G05B19/02; G05B19/18; G05B19/416; G05B19/418; G05B19/41815; G05B19/4182; G05B2219/00; G05B2219/30; G05B2219/40; G05B2219/40523; G05B2219/43; G05B2219/43005; G05B2219/43009; G05B2219/43105; Y; Y02; Y02P; Y02P90/00; Y02P90/02
Claims Analysis
Total Claims: 18
Claim 1
Independent Claim
200 words
A method for planning a path for a device in Cartesian space having a plurality of Cartesian components, the device being movable along axes defining an axis space, the method comprising the steps of: (a) receiving a first motion command from a user program, the motion command having desired motion-type information in the Cartesian space, and also having position and velocity information, the position, velocity and motion-type information defining a desired path; (b) setting a constant velocity parameter based upon the velocity information; (c) planning a set of interpolation parameters based on the position, velocity and motion-type information and based upon the constant velocity parameter; (d) computing a plurality of intermediate Cartesian positions including location and orientation components based upon the interpolation parameters, the intermediate Cartesian positions being on the desired path; (e) transforming the orientation components of the intermediate Cartesian positions into transformed orientation components; (f) smoothing the location components and the transformed orientation components into smoothed location and smoothed transformed orientation components; (g) inverse transforming the smoothed transformed orientation components into inverse transformed orientation components; and (h) generating a plurality of commands in the axis space based upon the smoothed location components and the inverse transformed orientation components.
Claim 2
Independent Claim
200 words
A method for planning a path for a device in Cartesian space having a plurality of Cartesian components, the device being movable along axes defining an axis space, the method comprising the steps of: (a) receiving a first motion command from a user program, the motion command having desired motion-type information in the Cartesian space, and also having position and velocity information, the position, velocity and motion-type information defining a desired path; (b) setting a constant velocity parameter based upon the velocity information; (c) planning a set of interpolation parameters based on the position, velocity and motion-type information and based upon the constant velocity parameter; (d) computing a plurality of intermediate Cartesian positions including location and orientation components based upon the interpolation parameters, the intermediate Cartesian positions being on the desired path; (e) transforming the orientation components of the intermediate Cartesian positions into transformed orientation components; (f) smoothing the location components and the transformed orientation components into smoothed location and smoothed transformed orientation components; (g) inverse transforming the smoothed transformed orientation components into inverse transformed orientation components; and (h) generating a plurality of commands in the axis space based upon the smoothed location components and the inverse transformed orientation components.
Claim 3
Dependent Claim
31 words
The method of claim 1 wherein the step of smoothing is accomplished with a plurality of cascaded linear filters, each of the cascaded linear filters corresponding to a respective Cartesian component.
Claim 4
Dependent Claim
15 words
The method of claim 2 wherein each cascaded linear filter has the same filter lengths.
Claim 5
Dependent Claim
14 words
The method of claim 2 wherein each of the cascaded linear filters has two-stages.
Claim 6
Dependent Claim
14 words
The method of claim 4 wherein each of the stages includes a shift register.
Claim 7
Dependent Claim
71 words
The method of claim 2 further comprising the steps of receiving a second motion command from the user program and blending the first and second motion commands by performing the steps (b)-(h) on the second motion command immediately after the steps (b)-(h) on the first motion command are completed, whereby the blending is achieved by the operation of the cascaded linear filters and the blended motion commands define a corner distance.
Claim 8
Dependent Claim
43 words
The method as claimed in claim 6 further comprising the step of modifying the location components and the transformed orientation components to the cascaded linear filters during the step of blending to thereby modify speed during blending wherein the corner distance is adjusted.
Claim 9
Dependent Claim
38 words
The method as claimed in claim 6 or claim 7 further comprising the step of modifying the length of the cascaded linear filters, whereby the duration in which blending occurs is modified and the corner distance is adjusted.
Claim 10
Independent Claim
205 words
A system for planning a path for a device in Cartesian space having a plurality of Cartesian components, the device being movable along axes defining an axis space, the system comprising: means for receiving a first motion command from a user program, the motion command having desired motion-type information in the Cartesian space, and also having position and velocity information, the position, velocity and motion-type information defining a desired path; means for setting a constant velocity parameter based upon the velocity information; means for planning a set of interpolation parameters based on the position, velocity and motion-type information and based upon the constant velocity parameter; means for computing a plurality of intermediate Cartesian positions including location and orientation components based upon the interpolation parameters, the intermediate Cartesian positions being on the desired path; means for transforming the orientation components of the intermediate Cartesian positions into transformed orientation components; means for smoothing the location components and the transformed orientation components into smoothed location and smoothed transformed orientation components; means for inverse transforming the smoothed transformed orientation components into inverse transformed orientation components; and means for generating a plurality of commands in the axis space based upon the smoothed location components and the inverse transformed orientation components.
Claim 11
Independent Claim
205 words
A system for planning a path for a device in Cartesian space having a plurality of Cartesian components, the device being movable along axes defining an axis space, the system comprising: means for receiving a first motion command from a user program, the motion command having desired motion-type information in the Cartesian space, and also having position and velocity information, the position, velocity and motion-type information defining a desired path; means for setting a constant velocity parameter based upon the velocity information; means for planning a set of interpolation parameters based on the position, velocity and motion-type information and based upon the constant velocity parameter; means for computing a plurality of intermediate Cartesian positions including location and orientation components based upon the interpolation parameters, the intermediate Cartesian positions being on the desired path; means for transforming the orientation components of the intermediate Cartesian positions into transformed orientation components; means for smoothing the location components and the transformed orientation components into smoothed location and smoothed transformed orientation components; means for inverse transforming the smoothed transformed orientation components into inverse transformed orientation components; and means for generating a plurality of commands in the axis space based upon the smoothed location components and the inverse transformed orientation components.
Claim 12
Dependent Claim
29 words
The system of claim 9 wherein the means for smoothing includes a plurality of cascaded linear filters, each of the cascaded linear filters corresponding to a respective Cartesian component.
Claim 13
Dependent Claim
15 words
The system of claim 10 wherein each cascaded linear filter has the same filter lengths.
Claim 14
Dependent Claim
14 words
The system of claim 10 wherein each of the cascaded linear filters has two-stages.
Claim 15
Dependent Claim
14 words
The system of claim 12 wherein each of the stages includes a shift register.
Claim 16
Dependent Claim
50 words
The system of claim 10 further comprising means for receiving a second motion command from the user program and means for blending the first and second motion commands, whereby the blending is achieved by the operation of the cascaded linear filters and the blended motion commands define a corner distance.
Claim 17
Dependent Claim
39 words
The system as claimed in claim 14 further comprising means for modifying the location components and the transformed orientation components to the cascaded linear filters during blending to thereby modify speed during blending wherein the corner distance is adjusted.
Claim 18
Dependent Claim
37 words
The system as claimed in claim 14 or claim 15 further comprising means for modifying the length of the cascaded linear filters, whereby the duration in which blending occurs is modified and the corner distance is adjusted.
References Cited (Backward Citations)
US4554497A
Cited
US4603286A
Cited
US4623971A
Cited
US4706003A
Cited
US4598380A
Cited
US4706204A
Cited
US4746251A
Cited
US4772831A
Cited
US4773025A
Cited
US4774445A
Cited
US4894596A
Cited
US5057756A
Cited
US5140236A
Cited
US5028855A
Cited
US5073748A
Cited
USPTO Annuity & Maintenance Windows
| Annuity Stage | Window Opens | Payment Deadline | Surcharge Period Until | Estimated Fee | Status |
|---|---|---|---|---|---|
| 3.5 Years (Year 4) | 1998-07-17 | 1999-01-16 | 1999-07-18 | $2000.00 | Window Closed / Lapsed |
| 7.5 Years (Year 8) | 2002-07-17 | 2003-01-16 | 2003-07-18 | $3760.00 | Window Closed / Lapsed |
| 11.5 Years (Year 12) | 2006-07-17 | 2007-01-16 | 2007-07-18 | $7700.00 | Window Closed / Lapsed |