CONTROL OF A ROBOT WITH DETERMINATION OF DAMPING DRIVE SIZE
Patent Information
- Application Number
- DE502016016795
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2015-11-19
- Filing Date
- 2016-11-09
- Publication Date
- 2024-11-28
- Estimated Expiration
- 2036-11-09
AI Technical Summary
Existing robot control systems fail to effectively manage speed limitations and damping near predetermined limits, leading to inefficient movement and potential collisions during compliance and manual guidance.
A method that determines the actual and target speeds of a robot based on predetermined maximum and minimum speeds, and distances to limits, using a damping drive variable to control the robot's movement, ensuring safe and efficient operation by adjusting speed and damping according to proximity to limits.
This approach allows for precise speed control and damping, preventing overshoot and ensuring safe operation by adjusting speed and damping based on proximity to limits, thereby enhancing the robot's movement efficiency and collision avoidance.
Description
[0001] The present invention relates to a method and a system for controlling a robot and a computer program product for carrying out the method.
[0002] From US 2004 / 0128026 A1, a robot controller with an admittance control is known, the control parameters of which are increased when the robot approaches a predetermined limit.
[0003] The object of the present invention is to improve a robot control system.
[0004] This object is achieved by a method having the features of claim 1. Claims 5 and 6 protect a system for controlling a robot according to a method described herein, and a computer program product for implementing a method described herein, respectively. The subclaims relate to advantageous developments.
[0005] According to one embodiment of the present invention, a method for controlling a robot comprises the following, in particular automated or computer-aided, steps: Determining an actual speed of the robot; determining a target speed; determining a damping drive variable based on or as a function of a difference between the target speed and the actual speed; and controlling a drive arrangement with one or more drives of the robot based on or as a function of the damping drive variable, wherein the target speed is determined based on or as a function of a predetermined maximum speed, a predetermined minimum speed and / or a distance or a distance of the robot from one or more predetermined limits.
[0006] A speed, in particular the actual and / or target speed, can in one embodiment comprise, in particular be, a one- or multi-dimensional translational and / or rotational speed of a robot-fixed reference, in particular the TCP, of the robot, in particular a speed (component) in one or more spatial directions or degrees of freedom. Likewise, a one- or multi-dimensional speed, in particular the actual and / or target speed, can in one embodiment comprise, in particular be, a translational and / or rotational speed of one or more drives and / or joints or joint degrees of freedom of the robot. It is referred to here in general terms as q designated.
[0007] In one embodiment, an actual speed can be detected by means of corresponding sensors, whereby in a further development a speed of a robot-fixed reference can be determined on the basis of a measured speed of joints of the robot by means of a forward transformation.
[0008] In one embodiment, the robot has one or more, in particular at least six or more, axes or joints, in particular rotary and / or linear or thrust axes or joints, and in a further development, drives, in particular electric motors, for moving the axes or joints. In one embodiment, it is an industrial robot.
[0009] A one- or multi-dimensional drive variable can, in one embodiment, comprise one or more drive forces and / or torques of the robot, in particular. It is generally referred to here as τ designated.
[0010] In one embodiment, the drive arrangement is controlled based on a drive variable, in particular the damping drive variable, and in a further development, one or more further drive variables, in particular the compliance drive variable explained below, in such a way that it (also) attempts to impose or exert this drive variable(s), in particular (also) imposes or exerts this, at least substantially. Accordingly, such a drive variable can include, in particular be, one or more desired or actual drive forces and / or torques of the robot or components thereof.
[0011] In one embodiment, the damping drive variable can advantageously dampen a movement of the robot, in particular a movement commanded by a compliance control and / or manual guidance of the robot. In other words, in one embodiment, damping is provided which, in a further development, advantageously acts in addition to or in parallel with damping within the framework of a compliance control.
[0012] By determining the target speed on the basis of the, in particular fixed or variable, predetermined one- or multi-dimensional maximum speed, in one embodiment a speed of the robot can be advantageously limited, in particular in the case of a movement commanded by a compliance control and / or manual guidance of the robot: if the actual speed exceeds the predetermined maximum speed, in a further development the damping drive variable brakes such a movement, in particular component by component.
[0013] By determining the target speed on the basis of the, in particular fixed or variable, predetermined one- or multi-dimensional minimum speed, in one embodiment a movement of the robot, in particular a movement commanded by a compliance control and / or manual guidance of the robot, below this minimum speed is advantageously influenced, in particular component-wise, only to a limited extent, in particular at least substantially, by the damping drive variable.
[0014] By determining a target speed on the basis of the one- or multi-dimensional distance of the robot from a predetermined limit, in one embodiment a movement of the robot, in particular a movement commanded by a compliance control and / or manual guidance of the robot, is advantageously damped more strongly by the damping drive variable when approaching or in the vicinity of the corresponding limit(s) or is damped less strongly by the damping drive variable when the distance to the respective limit is greater, so that a freer movement is advantageously enabled, in particular component-wise, in a permissible range defined by the limit(s).
[0015] In one embodiment, a distance of the robot from a predefined boundary can be a distance of a robot-fixed reference, in particular the TCP, of the robot from a boundary specified in the robot's workspace. Likewise, in one embodiment, a distance of the robot from a predefined boundary can include, in particular, a distance of a joint and / or drive position from a boundary specified in the joint or drive coordinate space of the robot.
[0016] In general, a one- or multi-dimensional upper limit is denoted by q max, a one- or multi-dimensional lower limit by q min and a one- or multi-dimensional (actual) pose or position of the robot in the working or joint or drive coordinate space of the robot by q is Then, in one embodiment, the one- or multi-dimensional distance dist i of the robot to a given limit i, in particular component-wise or for the j-th component or coordinate, according to dist i = q max , i − q ist bzw . dist j , i = q j , max , i − q j , ist or dist i = q ist − q min , i bzw . dist j , i = q j , ist − q j , min , i be defined or determined. It can be seen that in one embodiment, the distance is generally signed and, in particular component-wise, is positive precisely when the robot is below a specified upper or above a specified lower limit or in a permissible range, and conversely, in particular component-wise, is negative precisely when the robot is above a specified upper or below a specified lower limit or in an impermissible range.
[0017] Accordingly, in one embodiment, the target speed is generally determined, in particular component-wise, in such a way that, when the robot is at the same absolute distance from the same predetermined limit (absolute or taking into account the sign), it is greater if the robot is on a permissible side of the limit, and is smaller (absolute or taking into account the sign) if the robot is on an impermissible side of the limit.
[0018] Are available in one version n ≥ 1 limits are specified, in particular one or more upper and lower limits for one or more components or coordinates of the pose or position of the robot, in particular in the work or joint or drive coordinate space, then in a further development the (absolutely seen) smallest distance, in particular the (absolutely seen) smallest component of the multi-dimensional distance, is considered to be the (one-dimensional) distance distof the robot to all these given limits, i.e. the largest negative distance in terms of magnitude: dist = min i = 1 , … , n j = 1 , … , ƒ dist j , i ; dist = dist , dist , … T
[0019] This advantageously takes into account any limit that may be most severely violated. Likewise, the distance on the basis of which the target speed is determined can also be multidimensional, in particular for different spatial directions of the workspace or for different joints or drives of the robot, or for each component: dist j = min i = 1 , … , n dist j , i ; dist = dist 1 , dist 2 , … , dist ƒ T
[0020] The above-mentioned compliance drive variable is determined based on an impedance or admittance control and the drive arrangement is controlled based on a sum of the damping drive variable and the compliance drive variable.
[0021] The impedance or admittance control imparts a spring-damper or a mass-spring-damper characteristic of the robot, so that it follows a virtual spring or spring-damper arrangement or (re)acts as a (mass)-spring(-damper) system with a stiffness and / or damping that can be specified by control parameters. In this regard, reference is additionally made to the aforementioned US 2004 / 0128026 A1. For a more compact presentation, a control is also generally referred to as a controller within the meaning of the present invention, so that, for example, controlling a robot or controlling a drive arrangement also includes, in particular, regulating the robot or regulating the drive arrangement.
[0022] A known compliance control can achieve advantageous robot behavior, in particular manual guidance and / or advantageous collision behavior. Since the damping drive variable is applied additively to the compliance drive variable of the compliance control, or the drive arrangement is controlled based on the sum of the damping and compliance drive variables, the damping of the compliance control can advantageously be matched to its stiffness, in particular to reduce, and in particular to avoid, overshoot. At the same time, the independent damping drive variable can provide a limitation to a maximum speed and / or greater damping near specified limits.
[0023] Accordingly, in a further development, a damping, in particular a damping parameter or coefficient, of the compliance control depends on a stiffness, in particular a stiffness parameter or coefficient, of the compliance control, in particular linearly and / or on the basis of a Lehr damping.
[0024] In one embodiment, the target speed, which is subsequently defined without loss of generality as q should is designated, in particular component-wise, in terms of amount by the specified maximum speed, which is subsequently, without loss of generality, q max, is limited. Additionally or alternatively, the target speed is q should , especially component-wise, in terms of amount by the given
[0025] Minimum speed, which is subsequently calculated without loss of generality with q min, is limited downwards: q ˙ min ≤ q ˙ soll ≤ q ˙ max
[0026] Multidimensional velocities can be limited component by component: q ˙ j , min ≤ q ˙ j , soll ≤ q ˙ j , max
[0027] In one embodiment, the target speed can be determined, in particular component by component, according to q ˙ soll = K Pq ⋅ dist or q ˙ soll = K Pq ⋅ dist + q ˙ min with the given one- or multi-dimensional positive constant K Pq = diag ( K1,Pq,K2,Pq,... ) and the vector |q̇ min | = [|q̇ 1,min |,|q̇ 2,min |,...] T< be defined or determined, whereby the one- or multi-dimensional distance can be defined or determined in particular according to equation (1)-(1"), in particular under the additional boundary condition (2): dist j < 0 ⇒ 3 q ˙ j , soll < 0 ⇒ 2 q ˙ j , soll = q ˙ j , min or dist j < 0 ⇒ 3 ′ q ˙ j , soll < q ˙ j , min ⇒ 2 q ˙ j , soll = q ˙ j , min
[0028] In other words, in one embodiment, the specified minimum speed is determined as the target speed, in particular component-wise, if the robot is in the inadmissible area beyond the specified limit(s) ( dist ( j ) < 0).
[0029] Additionally or alternatively, in one embodiment, in particular component-wise, the specified maximum speed is determined as the target speed under the additional boundary condition (2) if the robot is in the permissible range on this side of the specified limit(s) ( dist ( j ) > 0) and has a given distance from them: K j , Pq ⋅ dist j > q ˙ j , max ⇒ 3 q ˙ j , soll > q ˙ j , max ⇒ 2 q ˙ j , soll = q ˙ j , max or K j , Pq ⋅ dist j + q ˙ j , min > q ˙ j , max ⇒ 3 ′ q ˙ j , soll > q ˙ j , max ⇒ 2 q ˙ j , soll = q ˙ j , max
[0030] Additionally or alternatively, in one embodiment, the target speed increases, in particular component-wise, in terms of amount with the distance of the robot to a predetermined limit, in particular linearly or according to equation (3) or (3'), if the robot is on a permissible side of this limit, in particular up to the predetermined maximum speed.
[0031] As explained above, this can apply in particular component-wise, for example for the j-th component q̇ j,should the target speed q̇ should : q ˙ j , soll = K j , Pq ⋅ dist j or q ˙ soll , j = K j , Pq ⋅ dist j + q ˙ j , min where dist (j) the one-dimensional distance or the corresponding j-th component of the multi-dimensional distance according to equation (1)-(1") and q j ,min can be the one-dimensional minimum velocity or the corresponding component of the multi-dimensional minimum velocity.
[0032] In one version, the damping drive variable, which is generally referred to as τ d is called, in particular component-wise, in the opposite direction to the actual speed, which is generally referred to as q is or seeks to reduce it. Taking the signs into account, in one embodiment, in particular q ˙ ist > 0 ⇒ τ d ≤ 0 ; q ˙ ist < 0 ⇒ τ d ≥ 0 or q ˙ j , ist > 0 ⇒ τ j , d ≤ 0 ; q ˙ j , ist < 0 ⇒ τ j , d ≥ 0
[0033] In addition, the damping drive size τ d , in particular component by component, is determined in such a way that it is equal to zero if the (component of the) target speed exceeds the (component of the) actual speed in terms of amount: q ˙ soll > q ˙ ist ⇒ τ d = 0
[0034] In other words, in one embodiment, at least essentially, no damping drive variable or component is imposed or commanded in the corresponding degree of freedom if the actual velocity is below the target velocity. As mentioned, equation (7') can apply, in particular, component-wise: q ˙ j , soll > q ˙ j , ist ⇒ τ j , d = 0
[0035] Additionally or alternatively, in one version the damping drive size τ d , in particular component-wise, by a given maximum size, which is subsequently defined without loss of generality as τ max, is limited to the upper limit: τ d ≤ τ max or τ j , d ≤ τ j , max
[0036] In addition, the damping drive variable is determined, in particular component-wise, in such a way that its amount is proportional to the difference between the (corresponding component of the) target speed and the (corresponding component of the) actual speed, if the (corresponding component of the) actual speed exceeds the (corresponding component of the) target speed in terms of amount: q ˙ ist − q ˙ soll > 0 ⇒ τ d = K Pν ⋅ q ˙ soll − q ˙ ist with the given one- or multidimensional constant K PV = diag ( K 1, PV ,...), in particular under the additional boundary condition (6), (7') and / or (8). The boundary condition (6) can in particular be q ˙ ist − q ˙ soll > 0 ⇒ τ d = sgn q ˙ ist ⋅ K Pν ⋅ q ˙ soll − q ˙ ist be taken into account with the sign or signum function sgn, where τ d and q is are defined with the same sign, ie the damping drive size τ d the actual speed q is is directed or acts in opposite directions.
[0037] As already mentioned, equations (9')-(9") can also be valid, especially component-wise: q ˙ j , ist − q ˙ j , soll > 0 ⇒ τ j , d = K j , Pν ⋅ q ˙ j , soll − q ˙ j , ist or q ˙ j , ist − q ˙ j , soll > 0 ⇒ τ j , d = sgn q ˙ j , ist ⋅ K j , Pν ⋅ q ˙ j , soll − q ˙ j , ist
[0038] According to the present invention, a system for controlling a robot is provided according to claim 5.
[0039] In one embodiment, the system comprises means for limiting the target speed by the predetermined maximum speed upwards and / or by the predetermined minimum speed downwards.
[0040] In one embodiment, the system comprises means for determining the target speed such that, for the same absolute distance of the robot from the same predetermined limit, it is greater if the robot is on a permissible side of the limit, and is smaller if the robot is on an impermissible side of the limit.
[0041] In one embodiment, the system comprises means for limiting the damping drive variable, in particular component-wise, by a predetermined maximum value upwards.
[0042] A means within the meaning of the present invention can be designed in hardware and / or software, in particular a processing unit, in particular a microprocessor unit (CPU), which is preferably connected to a memory and / or bus system in terms of data or signals, and / or can have one or more programs or program modules. The CPU can be designed to process instructions implemented as a program stored in a memory system, to detect input signals from a data bus, and / or to output signals to a data bus. A memory system can have one or more, in particular different, storage media, in particular optical, magnetic, solid-state, and / or other non-volatile media. The program can be designed in such a way that it embodies the methods described here orcapable of executing such a method, so that the CPU can execute the steps of such methods and thus, in particular, control the robot. Further advantages and features emerge from the subclaims and the exemplary embodiments. The following is shown, partially schematically: . Fig. 1: a robot and a system for controlling the robot according to an embodiment of the present invention; Fig. 2: a distance of the robot from predetermined limits; Fig. 3: a target speed as a function of the distance; Fig. 4: a damping drive variable as a function of the target and an actual speed; and Fig. 5: a method for controlling the robot according to an embodiment of the present invention.
[0043] Fig. 1, 5show a robot 1 with drives A 1 ,..., A 6 and a system with a controller 2 for controlling the robot 1 or a method carried out by the controller 2 for controlling the robot 1 according to an embodiment of the present invention.
[0044] In a first step S10, the controller 2 determines the distance dist of robot 1 to given limits q max , q min according to equations (1) to (1") explained above. This is in Fig. 2 illustrated. There, q is a detected actual position of the robot, 1, for example one or more of its Fig. 1 indicated joint angle q 1 ,...,q 6 or one or more components of a corresponding position and / or orientation of its TCP in the workspace. Accordingly, q max , q min must also be specified, particularly in the joint angle or working space.
[0045] In the illustrated pose of robot 1, the positive distance to the lower limit q min according to equations (1') is smaller than the equally positive distance to the upper limit q max according to equations (1) and is therefore calculated according to equations (1") as the distance dist of robot 1 to the specified limits q max , q min. For illustration, another actual position of the robot is shown in dashed lines in the invalid (hatched in Fig. 1 ) area above the specified upper limit q max is indicated, which would correspond to a negative distance < 0.
[0046] If limits are specified in several spatial directions or joints, the smallest distance (in absolute terms or with a sign) can be considered as the distance dist be determined as in Fig. 2 illustrated.
[0047] The distance determination can be carried out component by component in one version, as can the steps described below, so that q min , q max and q is each a component of the position along the Fig. 2 indicated coordinate axis.
[0048] Then, in a step S20, the controller 2 determines a target speed according to equation (3') under the additional boundary condition according to equation (2) q should . This is in Fig. 3 illustrated. On the one hand, one can see the linear dependence of the target speed q should from the (actual position-dependent) distance of robot 1 to the specified limits (cf. equation (3')) and on the other hand the absolute limitation of the target speed by a specified maximum speed q max upwards and through a given minimum speed q min downwards (see equation (2)). As mentioned, this can be done component by component, so that q should , q max and q min can each represent a component of the speed.
[0049] Then, in a step S30, the controller 2 determines a damping drive variable according to equation (9") under the additional boundary conditions (7') and (8) τ d . This is in Fig. 4 illustrated. One can see in this the limitation of the damping drive size τ d by the specified maximum size τ max according to equation (8). On the other hand, it becomes clear that the damping drive variable τ d is determined in such a way that it is equal to zero, provided that the target speed q should the actual speed q is in magnitude (cf. equation (7')). Conversely, if the actual speed q isthe target speed q should exceeds the value, the damping drive size τ d according to equation (9") in such a way that its magnitude is proportional to the difference between the target speed q̇ should and the actual speed q is growing until it reaches the maximum size τ max. The damping drive size is τ d according to equation (6) in the opposite direction to the actual speed q Again, as mentioned, this can be done component by component, so that q̇ should , q̇ is and τ d or τ max can each represent a component of the speed or a driving force or a driving (torque) of a drive A 1 ,...A 6 .
[0050] This damping drive size τd, the controller 2 commands in a step S40, in addition to a compliance drive variable, which is determined on the basis of an impedance or admittance control in a manner known per se and therefore not shown in detail here, to the drives A 1 ,..., A 6 of the robot 1.
[0051] Although exemplary embodiments have been explained in the preceding description, it should be noted that a multitude of modifications are possible. Thus, as mentioned several times, the steps can be performed in particular for one or more position, velocity, and drive variable components or degrees of freedom of the robot 1. The vectorially notated variables above can also be scalar, in particular, and denote a position, velocity, or drive variable in a spatial direction or a drive or joint coordinate degree of freedom.
[0052] The individual calculations or equations can be performed in the drive or joint coordinate space or in the robot's workspace, with variables being able to be transferred between these spaces as needed using forward or backward transformation. For example, specified limits in the workspace can be transformed into the drive or joint coordinate space, and drive forces or torques can then be determined directly there. Similarly, drive variables determined in the workspace can also be transformed into the drive or joint coordinate space. List of reference symbols
[0053] 1Robot 2Control A 1 ,..., A 6 Drive q 1 ,..., q 6 Joint angle q is Actual position q maximum, q my Upper / lower limit q should Target speed q is Actual speed q maximum, q my Maximum / minimum speed dist Distance τ d Damping drive size τ max Maximum size
Claims
1. A method of controlling a robot (1), the method comprising the steps of: determining (S30) an actual speed (q̇ist) of the robot; determining (S20) a target speed (q̇soll); determining (S30) a damping drive parameter (τd) on the basis of a difference between the target speed and the actual speed; and controlling (S40) a drive arrangement comprising at least one drive (A1 , ... , A6) of the robot on the basis of the damping drive parameter; wherein the target speed is determined on the basis of a predetermined maximum speed (q̇max), a predetermined minimum speed (q̇min) and / or a distance (dist) of the robot to at least one predetermined boundary (qmax, qmin characterised in that a compliance drive parameter is determined on the basis of an impedance or admittance control which provides a spring damper characteristic or a mass spring damper characteristic of the robot, and the drive arrangement is controlled on the basis of a sum of the damping drive parameter and the compliance drive parameter (S40); and in that the damping drive parameter is determined in such a way that it is equal to zero if the target speed exceeds the actual speed in terms of its absolute value, and the damping drive parameter is determined in such a way that, in terms of its absolute value, it is proportional to the difference between the target speed and the actual speed if the actual speed exceeds the target speed in terms of its absolute value.
2. The method according to claim 1, wherein, in terms of its absolute value, the target speed is limited, at the upper end, by the predetermined maximum speed and / or, at the lower end, by the predetermined minimum speed.
3. The method according to any one of the preceding claims, wherein, in terms of its absolute value, the target speed increases with the distance of the robot to the predetermined boundary when the robot is located on a permissible side of said boundary.
4. The method according to any one of the preceding claims, wherein, in terms of its absolute value, the damping drive parameter is limited, at the upper end, by a predetermined maximum value (τmax).
5. A system (2) for controlling a robot (1), wherein the system comprises: means (2) for determining an actual speed (q̇ist) of the robot; means (2) for determining a target speed (q̇soll); means (2) for determining a damping drive parameter (τd) on the basis of a difference between the target speed and the actual speed; and means (2) for controlling a drive arrangement comprising at least one drive (A1 , ... , A6) of the robot on the basis of the damping drive parameter; characterised in that the system is set up to carry out a method according to any one of the preceding claims.
6. A computer program product which comprises a program code which is stored on a computer readable medium, for carrying out the method according to any one of the preceding claims 1 to 4.
