Device, method and program for positioning multi-shaft mechanism

The positioning device for multi-axis mechanisms addresses precision and efficiency issues by using real-time measurement and learning models to dynamically update link parameters, ensuring accurate and efficient alignment of end effectors across varying conditions.

JP2024157089APending Publication Date: 2024-11-07KK TOSHIBA +1
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
JP2023071197
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-04-25
Publication Date
2024-11-07

AI Technical Summary

Technical Problem

Existing multi-axis mechanism positioning technologies face challenges in achieving high precision and efficiency due to changes in the center of gravity and physical deformations, leading to positioning errors and increased operation time, especially in intermediate postures and under external factors like earthquakes.

Method used

A positioning device for multi-axis mechanisms that includes a first acquisition unit for target values, a calculation unit for control amounts, a second acquisition unit for measurement values, and an updating unit to adjust link parameters based on real-time measurements and learning models, optimizing positioning accuracy and efficiency.

Benefits of technology

Enables highly accurate positioning of the end effector in all postures and reduces adjustment time by dynamically updating link parameters, ensuring precise alignment and efficient operation even under varying loads and external disturbances.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024157089000001_ABST
    Figure 2024157089000001_ABST
Patent Text Reader

Abstract

To provide a technique for positioning a multi-shaft mechanism to achieve positioning of an end effector position at high accuracy in every attitude, and to efficiently conduct adjustment work.SOLUTION: A positioning device 10 of a multi-shaft mechanism 20 includes: a first acquisition unit 11 for acquiring a position target value 18 of an end effector 23 provided at a tip of a plurality of links 22n(n=1-N) coupled via driving joints 21n(n=1-N); an arithmetic logical unit 15 for calculating a respective control amount 25n(n=1-N) of the driving joints 21n(n=1-N) for positioning the end effector 23 at the position target value 18, on the basis of a link parameter 13; a second acquisition unit 12 for acquiring a position measurement value 27 of the positioned end effector 23; and an update unit 16 for updating the link parameter 13 so that the position measurement value 27 coincides with the position target value 18.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] SUMMARY OF THE DISCLOSURE Embodiments of the present invention relate to techniques for positioning multi-axis mechanisms having end effectors. [Background technology]

[0002] In positioning the end effector of a multi-axis mechanism (e.g., a robot arm), calculations are performed based on forward kinematics using link parameters that represent the relationship between the links connected via drive joints (e.g., motors) and the displacement (rotation angle) of each drive joint.

[0003] Incidentally, in order to position the end effector with high accuracy, it is conceivable to directly detect the position of the end effector and perform feedback control. However, when it is difficult to detect the position of the end effector in this way, it is necessary to determine the link parameters with high accuracy and use open control. Thus, various control methods are being considered to achieve high-accuracy positioning of the end effector. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] Japanese Patent Application Publication No. 8-174453 [Patent Document 2] JP 2020-39893 A [Patent Document 3] Special Publication No. 2020-534051 Summary of the Invention [Problem to be solved by the invention]

[0005] However, when the center of gravity of a multi-axis mechanism changes significantly with a change in posture, the change in the amount of deflection will result in a positioning error of the end effector if a single link parameter is used. Therefore, a method of switching between multiple link parameters set for each representative posture has been considered. However, for intermediate postures that indicate the intermediate positions between different representative postures, it is sometimes difficult to ensure sufficient accuracy because appropriate link parameters cannot be found.

[0006] In addition, in the control method of grasping and aligning the position of the end effector using images, alignment is always performed by monitoring images, so even when repeating the same operation performed in the past, a correction operation for the amount of deviation occurs every time, making it impossible to reduce the operation time and making work inefficient.

[0007] Furthermore, if a physical deformation or misalignment occurs suddenly in the equipment due to external factors such as an earthquake, the user will adjust it to the extent possible, but due to time constraints on the work, the position accuracy cannot be guaranteed in postures other than those during adjustment. There is also a concern that the time required for positioning will increase.

[0008] An embodiment of the present invention has been made in consideration of these circumstances, and has an object to provide a positioning technology for a multi-axis mechanism that can achieve high-precision positioning of the end effector in any posture and also enable adjustment work to be performed efficiently. [Means for solving the problem]

[0009] A positioning device for a multi-axis mechanism according to an embodiment includes a first acquisition unit that acquires a position target value of an end effector provided at the tip of a plurality of links connected via drive joints, a calculation unit that calculates a control amount of each of the drive joints that positions the end effector at the position target value based on link parameters, a second acquisition unit that acquires a position measurement value of the positioned end effector, and an update unit that updates the link parameters so that the position measurement value matches the position target value. Effect of the Invention

[0010] According to an embodiment of the present invention, a positioning technique for a multi-axis mechanism is provided that enables highly accurate positioning of the end effector in any posture and allows adjustment work to be performed efficiently. [Brief description of the drawings]

[0011] [Figure 1] 1 is a block diagram of a positioning device for a multi-axis mechanism according to a first embodiment of the present invention. [Diagram 2] FIG. 11 is a block diagram of a positioning device for a multi-axis mechanism according to a second embodiment. [Diagram 3] FIG. 11 is a block diagram of a positioning device for a multi-axis mechanism according to a third embodiment. [Figure 4] FIG. 13 is a block diagram of a positioning device for a multi-axis mechanism according to a fourth embodiment. [Diagram 5] 1 is a diagram showing the posture patterns that a multi-axis mechanism can take due to the connected links. [Figure 6] A data set that links various conditions such as load values, link attitudes, and deviation amounts to link parameters. [Figure 7] (A) A graph showing the amount of deviation that occurs in the position of the end effector to be grasped based on the position measurement value and the position target value before an external factor is applied, and (B) a graph showing the amount of deviation that occurs in the position of the end effector to be grasped based on the position measurement value and the position target value after an external factor is applied. [Figure 8] 4 is a flowchart showing steps of a multi-axis mechanism positioning method and an algorithm of a multi-axis mechanism positioning program according to the embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0012] (First embodiment) Hereinafter, an embodiment of the present invention will be described with reference to the accompanying drawings. FIG. 1 is a block diagram of a positioning device 10A (10) (hereinafter, simply referred to as "device 10A") of a multi-axis mechanism 20 according to a first embodiment of the present invention. Here, the multi-axis mechanism 20 includes a drive joint 21. n(n=1 to N; n is a natural number) n An end effector 23 is provided at the tip of each of the sensors (n=1 to N).

[0013] The multi-axis mechanism 20 shown in the embodiment is an example of a treatment table for radiation therapy that aims radiation at a lesion at any position on the patient. Here, the end effector 23 is a bed on which the patient lies down, and is supported at the tip of a 7-axis (N=7) multi-joint link structure. Note that the end effector 23 of the multi-axis mechanism 20 is not limited to such a treatment table, and a machining tool can also be used. In addition, the drive joint 21 n In the illustrated embodiment, all of the components are made up of rotors (rotating bodies) such as motors, but all or part of the components may be made up of linear bodies.

[0014] The device 10A has a drive joint 21 n A plurality of links 22 connected via (n=1 to N) n A first acquisition unit 11 acquires a position target value 18 of an end effector 23 provided at the tip of the end effector 23 (n=1 to N), and a drive joint 21 positions the end effector 23 at the position target value 18. n Each control amount (n=1 to N) 25 n The system is equipped with a calculation unit 15 that calculates (n=1 to N) based on the link parameters 13, a second acquisition unit 12 that acquires a position measurement value 27 of the positioned end effector 23, and an update unit 16 that updates the link parameters 13 so that the position measurement value 27 matches the position target value 18.

[0015] The position target value 18 and the position measurement value 27 are both values ​​that define the position and orientation of the end effector 23 in a global coordinate system that defines the three-dimensional space in which the multi-axis mechanism 20 is disposed. n Link 22, which originated from n A number of local coordinate systems are defined based on the link 22. n Drive joint 21 at the other end ofn+1 Control amount 25 n+1 is set.

[0016] And the set control amount 25 n (n=1 to N) based on the driving unit 26 n (n=1 to N) and drive joint 21 n (n=1~N) displacement φ n (n=1~N). This gives link 22 n In the local coordinate system defined by link 22 n+1 And further link 22 N The end effector 23 can be expressed in a local coordinate system defined by the link 22 that interconnects the end effector 23 and the link 22. n (n=1 to N) and the position and orientation of the end effector 23 can be expressed by converting from a plurality of local coordinate systems to a global coordinate system.

[0017] The position target value 18 of the end effector 23 is information provided by the host control system 17. When the end effector 23 is a treatment couch for radiation therapy, the position target value 18 is determined based on a treatment plan formulated prior to radiation irradiation. In this treatment plan, X-ray CT scan is performed to obtain three-dimensional image data of the inside of the patient's body, the lesion range is grasped three-dimensionally, and the irradiation direction and irradiation intensity of radiation are determined so as to reduce irradiation of normal tissue. Then, the radiation is aimed at the lesion of the patient guided by the treatment plan, and the lesion of the patient laid on the end effector 23 (treatment couch) is determined as the position target value 18. Then, this position target value 18 is acquired by the first acquisition unit 11.

[0018] Link parameter 13 is the drive joint 21 n (n=1~N) control amount 25 nThe link parameters 13 are included in a mathematical expression that expresses the relationship between the position target value 18 (n=1 to N) and the position and posture of the end effector 23 in the global coordinate system based on kinematics. In other words, when the first acquisition unit 11 acquires the position target value 18, the calculation unit 15 controls the drive joint 21 based on the link parameters 13 so that the end effector 23 is positioned at the position target value 18. n Each control amount (n=1 to N) 25 n Calculate (n=1 to N).

[0019] Here, drive joint 21 n and Link 22 n In this case, the drive joint 21 is moved by the load on the end effector 23. n and Link 22 n does not deform, the position measurement value 27 of the end effector 23 acquired by the second acquisition unit 12 coincides with the position target value 18. The link parameters 13 in such an ideal state are theoretically calculated based on kinematics and registered in advance as initial values ​​14.

[0020] However, in reality, the drive joint 21 n and Link 22 n The multi-axis mechanism 20 bends due to its own weight and the weight of an object placed on the end effector 23. For this reason, the position measurement value 27 and the position target value 18 do not match when the initial values ​​14 of the link parameters 13 are obtained by theoretical calculation.

[0021] Therefore, a measurement system 28 consisting of various sensors actually measures position measurement values ​​27 that indicate the actual position and orientation of the end effector 23 set in the global coordinate system. Then, the update unit 16 updates the link parameters 13 so that the position measurement values ​​27 acquired by the second acquisition unit 12 coincide with the position target values ​​18 acquired by the first acquisition unit 11.

[0022] The control amount 25 calculated by the calculation unit 15 based on the updated link parameters 13 is n(n=1 to N), the position measurement value 27 can be made to coincide with the position target value 18. Therefore, once the link parameters 13 are appropriately updated, the link 22 that is deflected by the load can be adjusted. n (n=1 to N), the end effector 23 supported at the tip of the actuator 11 can then be repeatedly positioned with high accuracy to the position target value 18. This makes it unnecessary to perform a correction operation for positioning, shortens the operation time, and enables the end effector 23 to be positioned with high accuracy.

[0023] Incidentally, the level at which multi-axis mechanism 20 bends due to a load (its own weight) is considered to depend on position target value 18. For this reason, the optimal link parameters 13 also change depending on position target value 18. Therefore, update unit 16 of device 10A registers a plurality of link parameters 13 that correspond to different positions in the global coordinate system and that make position measurement values ​​27 and position target values ​​18 coincide with each other.

[0024] The calculation unit 15 then calculates the control amount 25 based on the link parameters 13 corresponding to the position target value 18 acquired by the first acquisition unit 11. n (n=1 to N) is calculated. This makes it possible to repeatedly position the end effector 23 with high accuracy without depending on the position target value 18.

[0025] Second embodiment Next, a second embodiment of the present invention will be described with reference to FIG. 2. FIG. 2 is a block diagram of a positioning device 10B (10) (hereinafter simply referred to as "device 10B") of a multi-axis mechanism according to the second embodiment. In the device 10B of the second embodiment, in contrast to the device 10A of the first embodiment described above, the update unit 16 has a machine learning device 36 that learns the relationship between the position measurement value 27 and the corresponding link parameter 13. Then, by inputting the position target value 18 to the learning model 37 generated by this machine learning device 36, the corresponding link parameter 13 is updated. Note that in FIG. 2, parts having the same configuration or function as FIG. 1 are indicated by the same reference numerals, and duplicated explanations will be omitted.

[0026] By using such a learning model 37, even if the position target value 18 is set continuously and finely, it is possible to update the link parameters 13 to the optimum ones. As a result, even if the position target value 18 is set in small increments, the end effector 23 can be positioned with high accuracy.

[0027] Third embodiment Next, a third embodiment of the present invention will be described with reference to Fig. 3. Fig. 3 is a block diagram of a multi-axis mechanism positioning device 10C (10) (hereinafter simply referred to as "device 10C") according to the third embodiment. The device 10C of the third embodiment differs from the device 10A of the first embodiment in that the update unit 16 updates multiple links 22. n (n=1 to N) based on the load value 31 applied to each of the link parameters 13. In Fig. 3, parts having the same configuration or function as Fig. 1 are indicated by the same reference numerals, and duplicated explanations will be omitted.

[0028] This load value 31 is the driving joint 21 n (n=1~N) or link 22 n (n=1 to N) are output from a sensor detection system 32 provided in the link 22. n In addition, examples of the actuator include a strain sensor and a load cell provided in the drive joint 21. n and the rotation angle of the link 22 at the other end n From the difference in rotation angle of Link 22 n The amount of twist can be known, and the load value 31 can be grasped. The load value 31 may be obtained from a sensor detection system 32 or may be input by an operator.

[0029] The deflection level of the multi-axis mechanism 20 changes depending on the load value 31 applied in this manner. n (n=1~N) or link 22 n By optimizing the link parameters 13 in accordance with the load values ​​31 applied to (n=1 to N), the end effector 23 can be positioned with respect to the position target value 18 with high accuracy.

[0030] Figure 5 shows the connected links 22 n 11 is a diagram showing a pattern of postures taken by the multi-axis mechanism 20 by the multiple links 22 (n=1 to N). n The link parameters 13 are updated based on the postures of the multi-axis mechanism 20. The posture patterns of the multi-axis mechanism 20 are determined by the driving joints 21. n Each control amount (n=1 to N) 25 n (n=1 to N). In this way, the deflection level of the multi-axis mechanism 20 changes depending on the pattern of the posture taken by the multi-axis mechanism 20. Therefore, by optimizing the link parameters 13 in accordance with such a pattern of posture, it is possible to position the end effector 23 with respect to the position target value 18 with high accuracy.

[0031] (Fourth embodiment) Next, a fourth embodiment of the present invention will be described with reference to Fig. 4. Fig. 4 is a block diagram of a positioning device 10D(10) (hereinafter simply referred to as "device 10D") of a multi-axis mechanism 20 according to the fourth embodiment. In contrast to the device 10A of the first embodiment described above, the device 10D of the fourth embodiment has an update unit 16 that has a function of updating the link parameters 13 based on the deviation amount 35 of the position measurement value 27 caused by an external factor. In Fig. 4, parts having the same configuration or function as Fig. 1 are indicated by the same reference numerals, and duplicated explanations will be omitted.

[0032] Fig. 7(A) is a graph showing the amount of deviation occurring in the position of the end effector 23 to be grasped from the position measurement value 27 and the position target value 18 before an external factor is applied. Fig. 7(B) is a graph showing the amount of deviation occurring in the position of the end effector 23 to be grasped from the position measurement value 27 and the position target value 18 after an external factor is applied. When an external factor such as an earthquake, accident, etc. is applied and deviation 35 occurs in the assembly of the multi-axis mechanism 20 in this way, the positioning accuracy of the end effector 23 decreases (from P in Fig. 7(B)).

[0033] Therefore, in the basic posture when the multi-axis mechanism 20 is initialized, the deviation amount 35 of the end effector 23 occurring before and after the application of the external factor is obtained. This deviation amount 35 is calculated from the difference between the position measurement value 27 obtained by the measurement system 28 before the application of the external factor and the position measurement value 27 obtained by the measurement system 28 after the application of the external factor. The update unit 16 updates the link parameters 13 based on this deviation amount 35, thereby recovering the positioning accuracy of the end effector 23 (Q and after in FIG. 7B). As a result, even if the deviation amount 35 occurs in the assembly of the multi-axis mechanism 20 due to an external factor, it is sufficient to update the link parameters 13 based on this deviation amount 35, making it possible to automate the adjustment and shorten the adjustment time.

[0034] Fig. 6 shows a data set in which link parameters 13 are linked to various conditions such as load value 31, link posture (Fig. 5), and deviation amount 35. This data set registers link parameters 13 updated under multiple conditions and linked to these conditions. By managing link parameters 13 in this way, it is possible to select optimal link parameters 13 by inputting various conditions. As a result, by setting optimal link parameters 13 corresponding to a combination of various conditions, it is possible to position end effector 23 with high accuracy relative to position target value 18.

[0035] In the positioning device 10 (10A, 10B, 10C, 10D) of the multi-axis mechanism 20 in each embodiment, the position measurement value 27 can be an X-ray image of an object supported by the end effector 23. In this case, the position target value 18 becomes position data for aiming radiation in a radiation irradiation treatment plan. This makes it possible to eliminate the deviation between the irradiation position of radiation in radiation therapy and the position of the affected area by updating the link parameter 13, thereby improving the irradiation accuracy.

[0036] The steps of the method for positioning a multi-axis mechanism according to the embodiment and the algorithm of the program for positioning a multi-axis mechanism will be described with reference to the flowchart in Fig. 8 (see Fig. 1 as appropriate). First, the position target value 18 of the end effector 23 is obtained from the upper control system 17 (S11). Then, the link parameter 13 corresponding to the obtained position target value 18 is selected from those registered (S12). If there is no corresponding link parameter 13, the initial value 14 is selected.

[0037] Next, based on the selected link parameters 13, the drive joints 21 required to position the end effector 23 to the position target value 18 are calculated. n Each control amount (n=1 to N) 25 n (n=1 to N) is calculated (S13). n The end effector 23 is moved according to (n=1 to N) (S14).

[0038] Next, the position measurement value 27 obtained by measuring the installed end effector 23 by the measurement system 28 is obtained (S15). Then, if it is determined that the error of the position measurement value 27 is large with respect to the position target value 18 (S16; Yes), the link parameter 13 is updated (S17) so that the position measurement value 27 coincides with the position target value 18. Furthermore, the flow of (S13) to (S16) is repeated.

[0039] Next, if it is determined that the error of the position measurement value 27 with respect to the position target value 18 is small (S16; No), the link parameters 13 are registered (S18) in association with various conditions such as the various position target values ​​18, the load value 31, and the link attitude (FIG. 5). Then, the work of the end effector 23 installed at the position target value 18 is performed (S19). Furthermore, the flow of (S11) to (S19) is repeated until there is no work for the end effector 23 at the next position target value 18 (S20; No, Yes, END).

[0040] In this way, the link parameters 13 that are optimal for various conditions can be registered while the end effector 23 continues to work. This eliminates the need to perform positioning operations of the multi-axis mechanism 20 just to optimize the link parameters 13. Furthermore, the more link parameters 13 that correspond to various conditions are registered, the less likely it is that the position measurement value 27 will have a large error (S16; Yes). This reduces the repetition of (S13) to (S16), shortens the operating time of the multi-axis mechanism 20, and makes the work of the end effector 23 more efficient.

[0041] According to at least one of the embodiments of the positioning device for a multi-axis mechanism described above, highly accurate positioning of the end effector can be achieved in any posture, and adjustment work can also be performed efficiently.

[0042] Although some embodiments of the present invention have been described, these embodiments are presented as examples and are not intended to limit the scope of the invention. These embodiments can be implemented in various other forms, and various omissions, substitutions, modifications, and combinations can be made without departing from the spirit of the invention. These embodiments and their modifications are included in the scope of the invention and its equivalents described in the claims, as well as in the scope and spirit of the invention.

[0043] The positioning device for a multi-axis mechanism described above includes a control device with a highly integrated processor such as a dedicated chip, a field programmable gate array (FPGA), a graphics processing unit (GPU), or a central processing unit (CPU), a storage device such as a read only memory (ROM) or a random access memory (RAM), an external storage device such as a hard disk drive (HDD) or a solid state drive (SSD), a display device such as a display, an input device such as a mouse or a keyboard, and a communication I / F, and can be realized with a hardware configuration using a normal computer. Therefore, the components of the positioning device for a multi-axis mechanism can also be realized by a computer processor and can be operated by a positioning program for the multi-axis mechanism.

[0044] The positioning program for the multi-axis mechanism is provided by being pre-installed in a ROM etc. Alternatively, this program may be provided by being stored in a computer-readable storage medium such as a CD-ROM, CD-R, memory card, DVD, or flexible disk (FD) in the form of an installable or executable file.

[0045] The positioning program for the multi-axis mechanism according to this embodiment may be stored on a computer connected to a network such as the Internet and provided by downloading it via the network. The positioning device for the multi-axis mechanism may also be configured by combining separate modules that independently perform the functions of the components and connect them to each other via a network or dedicated lines. [Explanation of symbols]

[0046] 10 (10A, 10B, 10C, 10D)... Multi-axis mechanism positioning device, 11... First acquisition unit, 12... Second acquisition unit, 13... Link parameter, 14... Initial value, 15... Calculation unit, 16... Update unit, 17... Upper control system, 18... Position target value, 20... Multi-axis mechanism, 21n (n=1~N)…Drive joint, 22 n (n=1~N)…Link, 23…End effector, 25 n (n=1 to N)...Control amount, 26...Drive unit, 27...Position measurement value, 28...Measurement system, 31...Load value, 32...Sensor detection system, 35...Displacement amount, 36...Machine learning machine, 37...Learning model, φ n (n=1~N)...Displacement amount.

Claims

1. a first acquisition unit that acquires a position target value of an end effector provided at an end of a plurality of links that are connected via a drive joint; a calculation unit that calculates a control amount of each of the drive joints that positions the end effector at the position target value based on link parameters; A second acquisition unit that acquires a position measurement value of the positioned end effector; an update unit that updates the link parameters so that the position measurement value coincides with the position target value.

2. 2. The positioning device for a multi-axis mechanism according to claim 1, the update unit registers a plurality of the link parameters corresponding to a plurality of different position target values, The calculation unit calculates the control amount based on the link parameter corresponding to the acquired position target value.

3. 2. The positioning device for a multi-axis mechanism according to claim 1, The update unit learns a relationship between the position target value and the corresponding link parameter, and updates the link parameter to correspond to the input position target value.

4. 4. The positioning device for a multi-axis mechanism according to claim 1, The update unit updates the link parameters based on load values ​​applied to each of the links.

5. 4. The positioning device for a multi-axis mechanism according to claim 1, The update unit updates the link parameters based on the postures taken by the multiple links.

6. 4. The positioning device for a multi-axis mechanism according to claim 1, The update unit updates the link parameters based on a deviation of the position measurement value caused by an external factor.

7. 4. The positioning device for a multi-axis mechanism according to claim 1, A positioning device for a multi-axis mechanism, wherein the position measurement value is obtained by X-ray photography of an object supported by the end effector.

8. acquiring a target position value of an end effector provided at an end of a plurality of links connected via drive joints; calculating a control amount of each of the drive joints for positioning the end effector at the position target value based on link parameters; obtaining position measurements of the positioned end effector; updating the link parameters so that the measured position values ​​match the target position values.

9. On the computer, acquiring a target position value of an end effector provided at an end of a plurality of links connected via drive joints; calculating a control amount of each of the drive joints for positioning the end effector at the position target value based on link parameters; obtaining position measurements of the positioned end effector; updating the link parameters so that the position measurement value coincides with the position target value.

Citation Information

Patent Citations

  • Robot control device and robot controlling method

    JP2017213668A

  • Surgical robot with passive end effector

    JP2021053395A

  • Fingertip load estimation device, robot control system and robot system

    JP2022159755A

  • Robot control device

    WO2022025060A1

  • Measuring device of positioning error in robot device and correcting method for positioning error

    JP1996174453A