Method And Control System For Controlling An Industrial Actuator
20210260761 · 2021-08-26
Inventors
- Mikael Norrlöf (Norrköping, SE)
- Markus Enberg (Västerås, SE)
- Morten Åkerblad (Västerås, SE)
- Philippe Charles (L'ISLE ADAM, FR)
- Jan Bronkhorst (Amersfoort, NL)
- Ron Nakken (Bunsbeek, BE)
- Haayo Terpstra (Amersfoort, NL)
Cpc classification
G05B19/416
PHYSICS
B25J9/1664
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A method for controlling an industrial actuator (26), the method comprising defining a movement path (10) as a sequence of a plurality of consecutive movement segments (14), where each movement segment (14) is defined between two points (16); defining at least one blending zone (12, 50, 52) associated with one of the points (16) between two consecutive movement segments (14), wherein the blending zone (12, 50, 52) is defined independently in relation to each of the two consecutive movement segments (14); and executing the movement path (10) comprising the blending zone (12, 50, 52) by the industrial actuator (26). A control system (30) for controlling an industrial actuator (26) and an actuator system (24) comprising an industrial actuator (26), are also provided.
Claims
1. A method for controlling an industrial actuator, the method comprising: defining a movement path as a sequence of a plurality of consecutive movement segments, where each movement segment is defined between two points; defining at least one blending zone associated with one of the points between two consecutive movement segments, wherein the blending zone is defined independently in relation to each of the two consecutive movement segments; and executing the movement path comprising the blending zone by the industrial actuator.
2. The method according to claim 1, wherein the blending zone is defined by means of two zone borders, and wherein each zone border is defined in relation to a respective one of the two consecutive movement segments.
3. The method according to claim 1, wherein the blending zone is defined with a factor from 0 to 1 in relation to each of the two consecutive movement segments.
4. The method according to claim 3, wherein the blending zone is defined with a different factor in relation to each of the two consecutive movement segments.
5. The method according to claim 1, wherein the at least one blending zone comprises a first blending zone associated with a first point, and wherein the method further comprises: defining at least one second blending zone associated with a second point, consecutive with the first point; and determining if there is an overlap between the first blending zone and the second blending zone.
6. The method according to claim 5, further comprising modifying the definitions of the first blending zone and the second blending zone, in relation to the movement segment between the first point and the second point, to an average value in relation to the movement segment between the first point and the second point, if it is determined that there is an overlap between the first blending zone and the second blending zone.
7. The method according to claim 5, further comprising reducing the largest of the first blending zone and the second blending zone, by modifying the definition in relation to the movement segment between the first point and the second point until the overlap is eliminated, if it is determined that there is an overlap between the first blending zone, and the second blending zone.
8. The method according to claim 5, further comprising reducing the blending zone of the first blending zone and the second blending zone that has the lowest priority, by modifying the definition in relation to the movement segment between the first point and the second point until the overlap is eliminated, if it is determined that there is an overlap between the first blending zone and the second blending zone.
9. The method according to claim 1, wherein the defining of at least one blending zone associated with one of the points comprises defining at least two blending zones and wherein each blending zone is defined independently in relation to each of the two consecutive movement segments.
10. The method according to claim 1, wherein the method further comprises simultaneously executing two consecutive movement segments within one of the at least one blending zone.
11. The method according to claim 1, wherein the method further comprises initiating a reorientation of a tool of the industrial actuator towards an orientation of the tool associated with one of the points, when the industrial actuator reaches one of the at least one blending zone associated with that point.
12. The method according to claim 1, wherein the method further comprises initiating an operation of an external device associated with one of the points of the movement path, when the industrial actuator reaches one of the at least one blending zone associated with that point.
13. The method according to claim 1, wherein the industrial actuator is an industrial robot.
14. A control system for controlling an industrial actuator, the control system comprising a data processing device and a memory having a computer program stored thereon, the computer program comprising program code which, when executed by the data processing device, causes the data processing device to perform the steps of: defining a movement path as a sequence of a plurality of consecutive movement segments, where each movement segment is defined between two points; defining at least one blending zone associated with one of the points between two consecutive movement segments wherein the blending zone is defined independently in relation to each of the two consecutive movement segments; and commanding the industrial actuator to execute the movement path comprising the blending zone.
15. An actuator system comprising a control system and an industrial actuator, the control system including a data processing device and a memory having a computer program stored thereon, the computer program having program code which when executed by the data processing device, causes the data processing device to perform the steps of: defining a movement path as a sequence of a plurality of consecutive movement segments, where each movement segment is defined between two points; defining at least, one blending zone associated with one of the points between two consecutive movement segments, wherein the blending zone is defined independently in relation to each of the two consecutive movement segments; and commanding the industrial actuator to execute the movement path comprising the blending zone.
16. The method according to claim 2, wherein the blending zone is defined with a factor from 0 to 1 in relation to each of the two consecutive movement segments.
17. The method according to claim 2, wherein the at least one blending zone comprises a first blending zone associated with a first point, and wherein the method further comprises: defining at least one second blending zone associated with a second point, consecutive with the first point; and determining if there is an overlap between the first blending zone and the second blending zone.
18. The method according to claim 2, wherein the defining of at least one blending zone associated with one of the points comprises defining at least two blending zones, and wherein each blending zone is defined independently in relation to each of the two consecutive movement segments.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0038] Further details, advantages and aspects of the present disclosure will become apparent from the following embodiments taken in conjunction with the drawings, wherein:
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
DETAILED DESCRIPTION
[0045] In the following, a method and a control system for controlling an industrial actuator to execute a movement path comprising at least one blending zone, will be described. The same reference numerals will be used to denote the same or similar structural features.
[0046]
[0047] The movement path 10 in
[0048] The first point 16a and the fourth point 16d are fine points (stop points). Therefore, no blending zones are defined in association with these points.
[0049] The second blending zone 12b is defined independently in relation to each of the two consecutive movement segments 14a, 14b and the third blending zone 12c is defined independently in relation to each of the two consecutive movement segments 14b, 14c. As a consequence, the blending zones 12b, 12c are not limited by symmetry.
[0050] The blending zones 12 may be defined in various ways. According to one example, the blending zones 12 are defined by means of zone borders. In
[0051] The maximum allowable size for a blending zone 12 may be exceeded for several reasons, including for example lack of skill or care by the programmer, changes made to the movement path 10, e.g. a reduced length of a movement segment 14, and automatic generation of the movement path lo based on sensor input, from e.g. a vision system, where the lengths of the movement segments 14 are not known beforehand. The method according to the present invention may comprise a limitation on the maximum size of each blending zone 12. One example of such limitation is that each blending zone 12 should be defined with a factor between 0 and 1 (i.e. between 0% and 100%) in relation to each of the two consecutive movement segments 14 with which the blending zone 12 is associated. In the example in
[0052] Furthermore, the definition of the third programmed blending zone 18c in relation to the second movement segment 14b is approximately 75%, which is well within this limitation. However, the definition of the third programmed blending zone 18c in relation to the third movement segment 14c is approximately 200%. Therefore, the definition of the third blending zone 12c is reduced to 100% in relation to the third movement segment 14c. The third blending zone 12c is thereby allowed to extend all the way to the fine point 16d.
[0053] In
[0054] One measure of handling overlaps includes modifying the definitions of the second blending zone 12b and the third blending zone 12c to an average value in relation to the second movement segment 14b, if it is determined that there is an overlap between the second blending zone 12b and the third blending zone 12c. In
[0055] An alternative measure of handling overlap includes reducing the largest of the second programmed blending zone 18b and the third programmed blending zone 18c. In
[0056] As an alternative measure of handling overlap, one or more programmed blending zones 18 may be prioritized. If for example the second programmed blending zone 18b is prioritized, the second programmed blending zone 18b remains unchanged (given that the second programmed blending zone 18b is defined with a factor from 0 to 1 in relation to each of the two consecutive movement segments 14a, 14b) and thereby constitutes the defined second blending zone 12b. In this case, the third programmed blending zone 18c, which has a lower priority than the second programmed blending zone 18b, is reduced by reducing the definition in relation to the second movement segment 14b until the overlap is eliminated.
[0057] In each of the above three examples, the blending zones 12b, 12c will be defined as illustrated in
[0058] Except for an optional limitation in maximum size of the blending zones 12, the blending zones 12 are only limited by the size of one or two adjacent blending zones 12 and eventually by distances to closest points. By defining the zone borders 20 of each blending zone 12 independently, the blending zones 12 can be made much larger.
[0059]
[0060] The curves 22b, 22c define the movement path 10 within the respective blending zones 12b, 12c. This defined movement path 10 is the same regardless of speeds and accelerations of the industrial actuator along the movement path 10. The geometry of the movement path 10 is defined independently of the dynamics of the industrial actuator. A dynamic coupling, e.g. speeds and accelerations of the industrial actuator along the movement path 10, may be generated in a second step to define a movement trajectory. The movement path 10 within the blending zones 12 may however be blended in various ways. Instead of curves 22, the movement path 10 may for example adopt various polynomial shapes within the blending zones 12. The movement path 10 within each blending zone 12 may alternatively be referred to as a corner path.
[0061] As illustrated in
[0062]
[0063] The external device 28 is configured to rotate the table 32 around an axis perpendicular to the plane of
[0064] The control system 30 is configured to control the industrial actuator 26 and optionally the external device 28 according to the present invention. The control system 30 comprises a data processing device 40 (e.g. a central processing unit, CPU) and a memory 42. A computer program is stored in the memory 42. The computer program comprises program code which, when executed by the data processing device 40, causes the data processing device 40 to perform the steps of defining a movement path 10 as a sequence of a plurality of consecutive movement segments 14, where each movement segment 14 is defined between two points 16; defining at least one blending zone 12 associated with one of the points 16 between two consecutive movement segments 14 of the movement path 10, wherein the blending zone 12 is defined independently in relation to each of the two consecutive movement segments 14 associated with the point 16; and commanding the industrial actuator 26 to execute the movement path 10 comprising the Cartesian position blending zone 12, an external device blending zone and/or an orientation blending zone. In the example of
[0065]
[0066]
[0067] During execution of the movement path 10 by the industrial actuator 26, an operation of the external device 28 associated with the point 16b is initiated when the industrial actuator 26 reaches the external device blending zone 50b associated with the point 16b, e.g. when the industrial actuator 26 reaches the one of two zone borders 60b1, 60b2 of the external device blending zone 50b (the zone borders 60b1, 60b2 may also be referred to with reference numeral “60”). Furthermore, during execution of the movement path 10 by the industrial actuator 26, a reorientation of the tool 38 towards an orientation of the tool 38 associated with the point 16b is initiated when the industrial actuator 26 reaches the orientation blending zone 52b associated with the point 16b, e.g. when the industrial actuator 26 reaches one of two zone borders 62b1, 62b2 of the orientation blending zone 52b (the zone borders 62b1, 62b2 may also be referred to with reference numeral “62”).
[0068] In the example of
[0069]
[0070] In
[0071] As shown in
[0072] As shown in
[0073] As shown in
[0074] As shown in
[0075] As shown in
[0076] The flexible definitions of the blending zones 12, 50, 52 according to the example in
[0077] The definitions of the blending zones 12, 50, 52 may also contribute to an improved performance of a handling operation, e.g. by maintaining a surface horizontal and/or by maintaining the tool 38 perpendicular.
[0078] While the present disclosure has been described with reference to exemplary embodiments, it will be appreciated that the present invention is not limited to what has been described above. For example, it will be appreciated that the dimensions of the parts may be varied as needed.