METHOD AND SYSTEM FOR DETERMINATION OF AT LEAST ONE PROPERTY OF A MANIPULATOR

• US 20160221189A1
• Filed: 08/25/2014
• Published: 08/04/2016
• Est. Priority Date: 08/27/2013
• Status: Active Grant

• Current Assignee: Cognibotics AB
• Original Assignee: Cognibotics AB
• Inventors: Nilsson, Adam, Olofsson, Bjorn, Robertsson, Anders, Sornmo, Olof, Nilsson, Klas, Haage, Mathias
• Granted Patent: US 9,908,238 B2
• Time in Patent Office: Days
• US Class Current: 1/1
• CPC Class Codes: B25J 9/1653 parameters identification, estimation, stiffness, accuracy, error analysis
• CPC Class Codes: G05B 2219/39183 Compliance compensation
• CPC Class Codes: G05B 2219/39186 Flexible joint
• CPC Class Codes: G05B 2219/40527 Modeling, identification of link parameters

Abstract

A method and system for determining at least one property associated with a selected axis of a manipulator (2). The elasticity of the links (4, 6, 9, 10, 13, 14) and joints (3, 5, 7, 8, 11, 12) of a manipulator (2) can be modeled and the resulting compliance can be determined. A certain method is used to control the manipulator (2) such that certain quantities related to actuator torque and/or joint position can be determined for a certain kinematic configuration of the manipulator (2). Depending on the complexity of the manipulator (2) and the number of properties that are of interest, the manipulator (2) is controlled to a plurality of different kinematic configurations in which configurations the quantities are determined. Thereafter, a stiffness matrix (K) for each component of the manipulator (2) can be determined, and a global stiffness matrix (MSM) for the total manipulator (2) can be determined in order to determine at least one property of the selected axis.

Claims

1-21. -21:

(canceled)

22. A method for determining at least one compliance property associated with a selected axis of a manipulator (2), wherein said manipulator (2) is configured to be controlled by a controller (19), and comprises at least one axis comprising a joint and a linkage connected to said joint, wherein the joint is configured to be actuated via a drive train by torque from an actuator, the method comprising:

(a) clamping a movable part of the manipulator (2) to a point in space by controlling the manipulator (2) such that the manipulator (2) attains a clamped kinematic configuration;

(b) selecting an identification joint set comprising at least one joint of the manipulator (2), wherein the at least one joint of the identification joint set is configured to control and monitor said selected axis whose associated at least one compliance property is to be determined;

(c) selecting an excitation joint set comprising at least one joint of the manipulator (2) which for the clamped kinematic configuration of the manipulator (2) is configured to excite at least one link of the selected axis connected to the at least one joint of the identification joint set;

(d) selecting a clamping configuration joint set of the manipulator (2), wherein the at least one joint of the clamping configuration joint set is not part of the identification joint set and the excitation joint set;

(e) actuating said excitation joint set, such that said selected axis is excited while controlling the clamping configuration joint set such that the clamped kinematic configuration is maintained;

(f) monitoring one or more quantities related to joint torque and joint position obtained from actuator torque and actuator position for at least one joint in the identification joint set and/or excitation joint set; and

(g) determining the at least one compliance property of said selected axis based on the one or more quantities monitored.

23. The method according to claim 22, wherein the compliance property is linear compliance for the link and/or joint of said selected axis.

24. The method according to claim 22, wherein the compliance property is torsional link compliance.

25. The method according to claim 23, wherein the compliance property is link-bending compliance.

26. The method according to claim 22, wherein the compliance property is non-linear orthogonal joint compliance.

27. The method according to claim 22, further comprising:

determining at least one property each for a plurality of selected axes of the manipulator (2).

28. The method according to claim 22, further comprising:

repeating the method wherein the attained clamped kinematic configuration of the manipulator (2) is different from a previously attained clamped kinematic configuration of the manipulator (2); and

determining at least one property of said selected axis based on the determined properties of said selected axis in the different clamped kinematic configurations.

29. The method according to claim 22, wherein the step of determining the at least one property comprises determining a manipulator stiffness matrix for the manipulator (2) based on the one or more monitored quantities.

30. The method according to claim 29, further comprising:

organizing properties according to a structure of the manipulator stiffness matrix that relates possibly unknown displacements of links and joints to torques and forces such that any combination of serial and parallel linkages can be represented, thereby facilitating the determination of these properties.

31. The method according to claim 22, wherein the step of determining the at least one property comprises performing an optimization based on the one or more monitored quantities.

32. The method according to claim 31, wherein the manipulator (2) is provided with a sensor configured to generate a sensor signal with sensor data when in said clamped kinematic configuration, and wherein the method further comprises:

including sensor data from the manipulator (2) in the optimization.

33. The method according to claim 32, wherein said sensor is a force sensor configured to generate a sensor signal with force data.

34. The method according to claim 22, wherein the clamping configuration joint set is controlled such that the clamping configuration joint set substantially does not influence the determination of the at least one property associated with the selected axis.

35. The method according to claim 22, further comprising:

comparing the at least one property with a previous obtained property value or predefined property value;

determining a difference value between the at least one property and the previous obtained property value or predefined property value; and

comparing the difference value with a difference threshold value and determining wear of the manipulator (2) based of the result of the comparison.

36. The method according to claim 22, wherein the manipulator is a parallel kinematic manipulator.

37. The method according to claim 22, further comprising:

obtaining specific kinematic parameters by means of kinematic calibration of a manipulator (2); and

updating kinematic parameters of the manipulator (2) based on said at least one determined property of said selected axis.

38. The method according to claim 22, wherein said at least one compliance property includes a compliance property used for updating nominal kinematic parameters of a manipulator (2).

39. The method according to claim 22, wherein said at least one compliance property includes a compliance property used for updating robot programs of a manipulator (2).

40. The method according to claim 22, wherein said at least one compliance property includes a compliance property used for motion control parameters of a manipulator (2).

42. A computer program embodied in a non-transitory medium (21) readable by a control unit (19), wherein the computer program comprises instructions executable by the control unit (19) to cause the control unit (19) to perform the method according to claim 22.

43. A computer program product comprising computer instructions stored on a non-transitory computer-readable storage medium (21), wherein the instructions are executable by a computer to perform the method according to claim 22.

41. A system (1) for determining at least one compliance property associated with a selected axis of a manipulator (2), the system (1) comprising:

a manipulator (2) with at least one axis comprising a joint and a linkage connected to said joint;

at least one actuator configured to actuate the joint via a drive train by means of actuator torque; and

a controller configured to control the manipulator (2), wherein the controller (19) comprises a control unit (20) and a computer readable storage unit (21) comprising instructions configured to;

(a) make the control unit (20) clamp a movable part of the manipulator (2) to a point in space by controlling the manipulator (2) such that the manipulator (2) attains a clamped kinematic configuration;

(b) select an identification joint set comprising at least one joint of the manipulator (2), wherein the at least one joint of the identification joint set is configured to control and monitor said selected axis whose associated at least one compliance property is to be determined;

(c) select an excitation joint set comprising at least one joint of the manipulator (2) which for the clamped kinematic configuration of the manipulator (2) is configured to excite at least one link of the selected axis connected to the at least one joint of the identification joint set;

(d) select a clamping configuration joint set of the manipulator (2), wherein the at least one joint of the clamping configuration joint set is not part of the identification joint set and the excitation joint set;

(e) actuate said excitation joint set, such that said selected axis is excited while controlling the clamping configuration joint set such that the clamped kinematic configuration is maintained;

(f) monitor one or more quantities related to joint torque and joint position obtained from actuator torque and actuator position for at least one joint in the identification joint set and/or in the excitation joint set;

(g) determine the at least one compliance property of said selected axis based on the one or more quantities monitored; and

(h) generate a property signal indicating said at least one compliance property.