Method and device for controlling a manipulator
View Patent ↗According to a method according to the invention for controlling a manipulator, in particular a robot ( 10 ), a planned path (z 1 (t)) of the manipulator is specified by a path generating device ( 1.1, 1.2, 1.3 ), a control path (z 2 (t)) is determined automatically on the basis of the planned path by a path conversion device ( 2 ), and the control path is traversed with the manipulator by a manipulator controller ( 3 ), with the path conversion device ( 2 ) determining curvature information (a ij ; t 2 (t i )) of the control path on the basis of curvature information (a ij ; t 1 (t i )) of the planned path.
1. A method for controlling a robotic manipulator, comprising:
obtaining a planned path for the robotic manipulator with a path generating device;
converting the planned path into a control path for the robotic manipulator with a path conversion device, wherein the control path includes curvature information that is determined on the basis of curvature information of the planned path; and
controlling the robotic manipulator to traverse the control path with a controller,
wherein the planned path further comprises a plurality of sections, and wherein converting the planned path into the control path comprises determining the curvature information of the control path on the basis of the curvature information of only fewer than all of the plurality of sections of the planned path; and
wherein there is a deviation of the curvature information between the planned path and the control path, and wherein the planned path and the control path arrive at the same destination.
2. The method of claim 1 , wherein the curvature information of the planned path comprises first-order or higher-order derivatives of the planned path with respect to a path parameter.
3. The method of claim 1 , wherein the curvature information of the planned path comprises either tangents of the planned path or first- order or higher-order derivatives of the tangents with respect to a path parameter.
4. The method of claim 3 , wherein the tangents or tangent derivatives are defined in a local coordinate system of a control point of the control path.
5. The method of claim 1 , wherein the curvature information of the planned path comprises first-order or higher-order polynomial coefficients.
6. The method of claim 1 , wherein at least one of the planned path or the control path comprises one or more splines, and wherein the splines are either of third or higher degree or are B splines.
7. The method of claim 1 , wherein the planned path comprises one or more Bezier curves, and wherein the curvature information of the planned path comprises the reference points of at least one of the Bezier curves.
8. The method of claim 1 , wherein the planned path and the control path each comprise a plurality of control points, and wherein the control path has fewer control points than the planned path.
9. The method of claim 8 , wherein converting the planned path to the control path utilizes a specified maximum deviation between the planned path and the control path.
10. The method of claim 1 , wherein at least one of the planned path and the control path comprises a Cartesian path of a reference system associated with a tool-center point of the robotic manipulator.
11. The method of claim 1 , wherein at least one control point is added to the planned path or to the control path based at least in part on the curvature information of the planned path and the control path such that the deviation between the planned path and the control path is limited.
12. A system for controlling a robotic manipulator, comprising:
a path generating device specifying a planned path for the robotic manipulator;
a path conversion device automatically determining a control path on the basis of the planned path, the conversion device determining curvature information of the control path on the basis of curvature information of the planned path; and
a controller controlling the robotic manipulator to traverse the control path,
wherein the planned path further comprises a plurality of sections, and wherein converting the planned path into the control path comprises determining the curvature information of the control path on the basis of the curvature information of only fewer than all of the plurality of sections of the planned path; and
wherein there is a deviation of the curvature information between the planned path and the control path, and wherein the planned path and the control path arrive at the same destination.
13. A program product, comprising:
a computer-readable medium; and
program code stored on the computer readable medium and configured to control a robotic manipulator;
the program code configured to obtain a planned path for the robotic manipulator;
the program code further configured to convert the planned path into a control path for the robotic manipulator, wherein curvature information of the control path that is determined on the basis of curvature information of the planned path; and
the program code further configured to control the robotic manipulator to traverse the control path;
wherein the planned path further comprises a plurality of sections, and wherein converting the planned path into the control path comprises determining the curvature information of the control path on the basis of the curvature information of only fewer than all of the plurality of sections of the planned path; and
wherein there is a deviation of the curvature information between the planned path and the control path, and wherein the planned path and the control path arrive at the same destination.