Patent Application
20230025318
The invention relates to a method for calibrating an impedance control of a robot manipulator and a robot system having a robot arm and having a control unit for carrying out the calibrated impedance control.
The object of the invention is to improve the impedance control of a robot manipulator or a robot system.
The invention results from the features of the independent claims. Advantageous refinements and embodiments are the subject matter of the dependent claims.
A first aspect of the invention relates to a method of calibrating an impedance control of a robot manipulator, wherein the robot manipulator includes a plurality of links connected to one another by joints, the method including:
Whether the counterforce of the robot manipulator based on the second determined deflection is actually applied in the last step of the method is irrelevant here, since the calibration of the impedance control is completed with the adaptation of the spring constant of the impedance control.
The impedance control preferably takes the following form:
u=−J
T(θ)(Kx{tilde over (x)}(θ)+Dx{dot over (x)}(ω))+g(θ), wherein the following applies: {tilde over (x)}(θ)=f(θ)−xs
wherein:
θ: are the joint angles of the robot manipulator;
u: is the counterforce of the robot manipulator;
JT(θ): is the transposed Jacobian matrix, depending on the current joint angles;
Kx: is the spring constant;
Dx: is the damping constant;
g(θ): is a gravity compensation of the impedance control;
{tilde over (x)}: is the deflection of the reference point of the robot manipulator;
{dot over (x)}: is the speed of the reference point of the robot manipulator;
xs: is the zero position of the reference point of the robot manipulator; and
f(θ): is the deflected position of the reference point of the robot manipulator.
In particular, when there is no speed of the reference point or no damping constant is provided, and neglecting the force of gravity, the adapted spring constant can be determined from the term u=−JT(θ)Kx{tilde over (x)} by appropriate transformation based on the second determined deflection.
The reference point of the robot manipulator is, in particular, any reference point of the robot manipulator that can be selected by a user, i.e., the reference point is arranged, imagined physically fixed on a limb or a joint or on another component of the robot manipulator, or at least moves in a physically fixed manner with the limb or the joint or the component of the robot manipulator.
The external position measuring unit differs from the joint angle sensors in particular in that it is not arranged on the robot manipulator itself and does not use the robot's own sensors. Instead, a motion capture system (so-called “motion capture system”) is preferably used as the position measuring unit, in which cameras detect light reflected from the robot manipulator or from special markers on the robot manipulator and, through their corresponding calibration, can detect the position of the reference point of the robot manipulator in the earth-fixed space quite precisely. Alternatively, another position measuring unit is preferably used, wherein a plurality of possible known position measuring units come into consideration, for example, electronic measuring sensors, ultrasonic distance measuring units, a radar unit, stereo cameras, etc.
The joint angle sensors of the robot manipulator, on the other hand, are in particular, the robot's own sensors, which detect a respective angle between two links of the robot manipulator that are connected to one another by a common joint. From the totality of all joint angles, a position of the reference point of the robot manipulator can be inferred, in particular with respect to an earth-fixed system, by corresponding coordinate system transformations or vector algebra or alternative mathematical methods. This naturally results in certain inaccuracies, since one or more of the joint angle sensors can have inaccuracies or errors, which can increase, in particular, in certain poses of the robot manipulator and due to the nature of the coordinate system transformations.
The spring constant of the impedance control can be a scalar spring constant or a spring constant in matrix form, which is particularly suitable for deflecting the reference point of the robot manipulator in different directions with directional dependence of the spring constant. In the latter case, the spring constant is preferably a diagonal matrix, but components outside the diagonal of a matrix-shaped spring constant are also possible, in particular, if couplings between the designed directions of the reference point of the robot manipulator are desired. The zero position of the reference point of the robot manipulator is that position, in particular, with respect to a Cartesian, earth-fixed coordinate system, in which the robot manipulator does not generate counterforce. This corresponds to the rest position of a real mechanical spring, in which the mechanical spring does not generate any force.
According to the invention, the deflection of the reference point of the robot manipulator is carried out simultaneously in two ways: on the one hand via the robot's own joint angle sensors, on the other hand via the external position measuring unit. Under the assumption that the measurements of the external position measuring unit are correct and only the joint angle sensors or at least one of them is faulty, the second determined deflection of the reference point of the robot manipulator can also be used to determine a counterforce, which the impedance control would have to apply based on this second determined deflection. This counterforce will deviate somewhat from the counterforce actually applied, since the joint angle sensors naturally output joint angles due to sensor noise, coordinate system transformation, and other effects, which result in a slightly different position of the reference point in an earth-fixed, Cartesian coordinate system than the determined position of the reference point of the robot manipulator, which is output from the external position measuring unit. Therefore, according to the invention, the spring constant of the impedance control is adapted in such a way that the counterforce applied by the robot manipulator against the deflection is or would be as large as if the impedance control had been calculated with the original spring constant using the second determined position of the reference point of the robot manipulator. According to the invention, the spring constant thus compensates for the measurement error of the joint angle sensors based on the position detection of the external position measuring unit.
It is an advantageous effect of the invention that the impedance control is adapted according to the inaccuracies and errors in the measurement of joint angles by joint angle sensors of the robot manipulator, and thus these inaccuracies and errors in the operation of a robot arm or robot manipulator are compensated for using the calibrated impedance control.
According to an advantageous embodiment, after the deflection of the reference point of the robot manipulator from the zero position to the deflected position, the reference point of the robot manipulator is held in the deflected position and the second determined deflection is detected while the reference point of the robot manipulator is being held in the deflected position, wherein the adaptation of the spring constant of the impedance control takes place in such a way that the counterforce applied by the robot manipulator corresponds to a stationary counterforce of the robot manipulator based on the second deflection. In particular, if the impedance control not only contains an artificial spring in the form of a spring constant, but also a damping constant that generates a speed-dependent counterforce against the movement of the reference point of the robot manipulator, this embodiment ensures that only the spring constant is adjusted depending on the second determined deflection, and speed influences due to the effect of the damping constant have no effect on the adaptation of the spring constant of the impedance control.
According to a further advantageous embodiment, the method further includes:
In contrast to the preceding embodiment, speeds of the reference point of the robot manipulator are explicitly taken into consideration in this embodiment. At least one speed is advantageously determined or detected at one location during the deflection of the reference point from its zero position to its deflected position and taken into consideration in addition to the current deflection. The speed measuring unit can be part of the position measuring unit and can be determined from the time derivative of measured positions.
According to a further advantageous embodiment, the spring constant is constant over the deflection of the reference point between its zero position and its deflected position. According to this embodiment, the spring constant is invariant over time, that is to say it does not change, in particular, over the deflection of the reference point of the robot manipulator. This creates a linear artificial spring for the reference point of the robot manipulator.
According to a further advantageous embodiment, the spring constant is dependent on the current deflection of the reference point of the robot manipulator. In contrast to the preceding embodiment, the impedance control has a non-linear spring law here due to the deflection-dependent spring constant. This is usable advantageously, in particular, when a nonlinear impedance control is desired for specific applications. The method according to the first aspect of the invention or the associated embodiments is advantageously repeated for multiple positions of the reference point of the robot manipulator as the zero position in space in order to obtain multiple support points for the adaptation of the spring constant, and thus to take into consideration the non-linearity of the artificial spring in the impedance control.
According to a further advantageous embodiment, the spring constant of the impedance control is adapted in modal coordinates. The modal coordinate transformation transforms the differential equation of the impedance control depending on, among other things, an inertia matrix of the impedance control, so that a coupled dynamic of the impedance control over different directions of deflection is decoupled by appropriate transformation and is provided in modal coordinates. This advantageously simplifies the design, in particular, of the spring constant, since the respective component of the spring constant can be adapted in decoupled coordinates. This method can also be applied to the design of a damping constant, if one is provided in the impedance control.
According to a further advantageous embodiment, the reference point of the robot manipulator is deflected from the zero position into the deflected position by manual guiding of the robot manipulator by a user.
According to a further advantageous embodiment, the reference point of the robot manipulator is deflected from the zero position into the deflected position by corresponding activation of actuators of the robot manipulator.
According to a further advantageous embodiment of the robot manipulator, the method includes repeating the deflecting the reference point, detecting the second determined deflection, and adapting the spring constant of the impedance control for a plurality of different deflection ranges and/or in different deflection directions of the reference point of the robot manipulator, wherein the spring constant is adapted in dependence on a respective deflection range and/or a respective deflection direction. In particular, this embodiment takes into consideration the fact that typically the errors and inaccuracies in the joint angle sensors of the robot manipulator are deflection-dependent and direction-dependent. A data series for different stiffness matrices over different deflection widths or different deflection directions is thus created and the errors and inaccuracies of the joint angle sensors of the robot manipulator are compensated for in an improved manner.
A further aspect of the invention relates to a robot system having a robot arm and having a control unit, wherein the control unit is designed to carry out an impedance control of the robot arm, wherein the impedance control is calibrated according to a method.
The robot system having the robot arm and having the control unit can coincide here with the robot manipulator according to the first aspect of the invention and its embodiments. This means that the adapted spring constant and/or the adapted damping matrix can also be used on the same robot manipulator on which the method for calibrating the impedance control is carried out. Alternatively, the method for calibrating the impedance control is preferably carried out on a first robot manipulator, and such a calibrated impedance control is used on a second or a plurality of second robot manipulators (i.e., the respective robot system having the robot arm and the respective control unit). The result of the calibration is thus also advantageously transferable from a robot manipulator to a robot system having a robot arm and a control unit.
Further advantages, features, and details will be apparent from the following description, in which—possibly with reference to the drawings—at least one example embodiment is described in detail. Identical, similar, and/or functionally identical parts are provided with identical reference numerals.
In the drawings:
The illustrations in the figures are schematic and not to scale.
Although the invention has been further illustrated and described in detail by way of preferred example embodiments, the invention is not limited by the disclosed examples, and other variations can be derived therefrom by a person skilled in the art without departing from the scope of protection of the invention. It is therefore clear that a plurality of possible variations exists. It is also clear that embodiments mentioned by way of example actually only represent examples, which are not to be construed in any way as limiting the scope of protection, the possible applications, or the configuration of the invention. Rather, the preceding description and the description of the figures enable a person skilled in the art to implement the example embodiments, wherein a person skilled in the art, knowing the disclosed concept of the invention, can make various changes, for example, with respect to the function or arrangement of individual elements cited in an example embodiment, without leaving the scope of protection as defined by the claims and their legal equivalents, such as more extensive explanations in the description.
| Number | Date | Country | Kind |
|---|---|---|---|
| 10 2019 131 401.1 | Nov 2019 | DE | national |
The present application is the U.S. National Phase of PCT/EP2020/082659, filed on 19 Nov. 2020, which claims priority to German Patent Application No. 10 2019 131 401.1, filed on 21 Nov. 2019, the entire contents of which are incorporated herein by reference.
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/EP2020/082659 | 11/19/2020 | WO |
