Method and system for detecting measurement precision of positioning mark center value of puncture surgery robot
By designing detection systems and methods in puncture surgical robots, using the coordinate conversion relationship between positioning marks and 3D vision cameras, the distance deviation of positioning marks is calculated, which solves the problem of 3D vision camera accuracy detection in puncture surgical robots and ensures the safety of the surgery and accuracy simplify the R&D process.
Patent Information
- Application Number
- CN202310575979.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-22
- Publication Date
- 2024-11-29
AI Technical Summary
In puncture surgical robots, there is a lack of applicable detection methods and systems to measure the accuracy of the 3D visual camera on the center value of the positioning mark, affecting the accuracy and safety of the surgery.
By designing a detection system and method, using multiple sets of positioning marks of different heights and placement angles in the detection device, combining the coordinate conversion relationship between the 3D vision camera and the CT machine, the distance deviation of the positioning marks is calculated and whether it meets the accuracy requirements. , a detection device with simple structure and easy assembly is adopted to calculate the average deviation and root mean square error to verify the accuracy of the 3D visual camera.
The accuracy detection of 3D vision cameras in puncture surgery robots is realized, ensuring the safety and accuracy of the surgery, verifying the feasibility of the application of 3D vision cameras, simplifying the R&D process, and improving the detection efficiency of puncture surgery robots.
Smart Images

Figure CN119043158A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of puncture surgical robots, and in particular to a method and system for detecting the measurement accuracy of a central value of a positioning mark of a puncture surgical robot. Background Art
[0002] The puncture surgical robot uses a 3D vision camera that is combined with the puncture needle and installed at the end of the robotic arm for positioning. The specific positioning process is to first use the 3D vision camera to take a picture of the calibration plate placed in the CT machine (bed) to determine the coordinate conversion relationship between the calibration plate coordinate system (also called world coordinates) and the robotic arm coordinate system, and then combine the CT scan data obtained after the CT machine scans the calibration plate placed in the CT bed to determine the coordinate conversion relationship between the CT machine coordinate system and the calibration plate coordinate system, thereby determining the coordinate conversion relationship between the CT machine coordinate system and the robotic arm coordinate system.
[0003] After determining the coordinate conversion relationship, during each puncture operation, the 3D vision camera will take a picture of the positioning mark placed at the puncture point on the surface of the target body, quickly identify and calculate the coordinate value A of the center point of the positioning mark, and the CT machine will scan the positioning mark to obtain the coordinate value B of the center point of the positioning mark in the CT machine coordinate system. The coordinate value B will be converted into the coordinate value C in the robotic arm coordinate system through the coordinate conversion relationship. The puncture surgery robot will decide whether to perform the puncture operation by judging and comparing the coordinate values A and C.
[0004] However, before performing the puncture surgery, it is first necessary to test the positioning accuracy of the entire puncture surgery robot. The core of the positioning accuracy test is to use a 3D vision camera to measure the coordinate value of the center point of the positioning mark (referred to as the midpoint value). That is, the measurement accuracy of the 3D vision camera for the coordinate value of the center point of the positioning mark must meet the accuracy requirements of the puncture surgery robot. The use of 3D vision cameras in puncture surgery robots is actually the first of its kind, and there is currently no applicable detection method and system. Summary of the invention
[0005] The purpose of the present invention is to provide a method and system for detecting the measurement accuracy of the center value of the positioning mark of a puncture surgery robot, which is used to detect the accuracy of the 3D vision camera in measuring and identifying the center value of the positioning mark, and to verify the feasibility of using the 3D vision camera in the puncture surgery robot.
[0006] The method for measuring the accuracy of the center value of the positioning mark of the puncture surgery robot in the present invention is performed according to the following steps:
[0007] 1) Installing the calibration plate in a detection device, wherein a plurality of groups of positioning marks with different heights and placement angles are fixedly installed in the detection device, wherein each group of the positioning marks is respectively installed in a corresponding test point with a fixed position, defining the origin of the coordinate system of the calibration plate, establishing the calibration plate coordinate system, and obtaining the coordinate value corresponding to the center point of each group of the positioning marks in the calibration plate coordinate system, which is called the first coordinate value;
[0008] 2) installing a 3D vision camera at the end of the mechanical arm of the puncture surgery robot, running and completing a calibration program, obtaining a conversion relationship between the calibration plate coordinate system and the mechanical arm coordinate system, and converting the first coordinate value into a coordinate value in the mechanical arm coordinate system according to the conversion relationship, which is called a fourth coordinate value;
[0009] 3) running the measurement program of the 3D vision camera to directly identify and obtain the coordinate value of the center point of each group of positioning marks in the robot arm coordinate system, which is called the fifth coordinate value;
[0010] The distance deviation between the fourth coordinate value and the fifth coordinate value of each group of positioning marks is calculated, and it is determined whether the distance deviation corresponding to each group of positioning marks is zero or within the allowable error range, so as to determine whether the measurement accuracy requirement of the positioning mark center value is met.
[0011] The method for detecting the measurement accuracy of the center value of the positioning mark of the puncture surgery robot in the present invention performs the following steps after step 1):
[0012] 2) converting the first coordinate value of the center point of each group of positioning marks into a coordinate value in the CT machine coordinate system according to the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system, which is called the second coordinate value;
[0013] 3) installing a 3D vision camera at the end of the robotic arm of the puncture surgery robot, running and completing a calibration program, obtaining a conversion relationship between the calibration plate coordinate system and the robotic arm coordinate system, and further obtaining a conversion relationship between the CT machine coordinate system and the robotic arm coordinate system based on the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system in step 2);
[0014] 4) running the measurement program of the 3D vision camera, obtaining the coordinate value of each group of the center point of the positioning mark in the robot arm coordinate system, and converting it into the coordinate value in the CT machine coordinate system according to the conversion relationship between the CT machine coordinate system and the robot arm coordinate system in step 3), which is called the third coordinate value;
[0015] The distance deviation between the third coordinate value and the second coordinate value of each group of positioning marks is calculated, and it is determined whether the distance deviation corresponding to each group of positioning marks is zero or within the allowable error range, so as to determine whether the measurement accuracy requirement of the positioning mark center value is met.
[0016] Preferably, the distance deviations of all the positioning marks are calculated according to the following formula:
[0017]
[0018] Where: i is the serial number of each group of positioning marks;
[0019] j and k are the coordinate values of the center point of the positioning mark obtained in different ways in the same coordinate system.
[0020] Preferably, the steps of summing up the distance deviations of each group of positioning marks and then averaging them, calculating the average deviation of all distance deviations, and calculating the root mean square error of all distance deviations are added.
[0021] Preferably, in step 2), the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system is obtained according to the following steps:
[0022] 2.1) Scanning the calibration plate in the detection device by a CT machine;
[0023] 2.2) Finding a one-to-one correspondence between the coordinate value of the center of the calibration ball in the calibration plate in the calibration plate coordinate system and the coordinate value of the center of the calibration ball in the CT machine coordinate system;
[0024] 2.3) Based on the one-to-one correspondence mentioned above, establish the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system.
[0025] Preferably, the placement angles of the positioning marks relative to the horizontal plane are 0 degrees, 30 degrees and 45 degrees respectively.
[0026] Preferably, a plurality of groups of positioning marks whose heights are distributed in an arithmetic progression are fixedly installed in the detection device.
[0027] The system for detecting the measurement accuracy of the center value of the positioning mark of the puncture surgery robot in the present invention includes a puncture surgery robot, a calibration plate, a test platform and a detection device. The puncture surgery robot includes a mechanical arm, an excitation device that combines a 3D visual camera and a puncture needle into an integral whole, and a puncture surgery robot controller. The detection device includes a base processed into an integral whole by a thick steel plate, and a plurality of positioning marks of different heights and different placement angles for detection assembled and connected to the base.
[0028] The detection method and system of the present invention adopts a detection device with a simple structure and convenient assembly. Since the detection device is easy to process, the processing accuracy can be guaranteed, providing sufficient prerequisites for the accuracy detection of the method and system. After using the detection device of the present invention, by obtaining the distance deviation Di of each calibration mark, it can be determined whether the distance deviation corresponding to each group of positioning marks is zero or within the allowable error range, so as to determine whether the measurement accuracy requirements of the center value of the positioning mark are met.
[0029] By calculating the average deviation ΔD and the root mean square error δ, it is possible to more accurately and scientifically determine whether the measurement accuracy requirements of the positioning mark center value are met, and whether the accuracy requirements of the 3D vision camera for measuring and identifying the positioning mark center value are met. This can verify the feasibility of using 3D vision cameras in puncture surgical robots and ensure the surgical safety of puncture surgical robots. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 It is a schematic diagram of the structure of the detection system of the present invention.
[0031] Figure 2 It is a schematic diagram of the three-dimensional structure when the detection device and the calibration plate in the present invention are combined.
[0032] Figure 3 It is a three-dimensional structural schematic diagram of the base in the present invention.
[0033] Figure 4 It is a schematic diagram of the three-dimensional structure of the calibration plate in the present invention.
[0034] Figure 5 It is a top view schematic diagram of the base in the present invention.
[0035] Figure 6 yes Figure 5 Schematic diagram of the cross-sectional structure along line AA.
[0036] Figure 7 yes Figure 5 Schematic diagram of the cross-sectional structure along line BB.
[0037] Figure 8 yes Figure 5 Schematic diagram of the cross-sectional structure along the CC line.
[0038] Fig. 9 It is a structural schematic diagram of the first base column block in the present invention.
[0039] Fig.10 It is a structural schematic diagram of the second base column block in the present invention.
[0040] Fig.11 It is a structural schematic diagram of the third base column block in the present invention. DETAILED DESCRIPTION
[0041] The specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
[0042] It should be noted that, in the present application, relational terms such as “first” and “second” are merely used to distinguish one component from another, and do not necessarily require or imply any actual relationship or order between the components.
[0043] like Figure 1 As shown, the system for measuring the center value of the positioning mark of the puncture surgery robot in the present invention includes a puncture surgery robot 3, a calibration plate 7, a test platform 6, and a detection device 1. The puncture surgery robot 3 includes a mechanical arm 2, an excitation device (not shown in the figure) that combines a 3D vision camera 4 and a puncture needle (not shown in the figure) into a whole, and a computer 5 (also called a controller of the puncture surgery robot) installed with 3D vision dedicated software. The excitation device assembled with the 3D vision camera 4 is detachably fixedly installed at the end of the mechanical arm 2.
[0044] like Figure 1 and Figure 2 As shown, the test platform 6 in the present invention can be a CT machine, and the detection device 1 is directly placed flat on the test platform 6, and the puncture surgical robot 3 is firmly placed next to the test platform 6 at a position that is convenient for the movement of the mechanical arm 2. Of course, the test platform 6 can also be a commonly used stable storage table. The scan data of the CT machine after scanning the calibration plate 7 and the coordinate data of the calibration ball 72 in the calibration plate coordinate system are input into the computer 5. The computer 5 calculates the coordinate conversion relationship ω1 between the CT machine coordinate system and the calibration plate coordinate system. The coordinate conversion relationship ω1 can also be placed in advance for direct call. In this way, the accuracy detection can be completed without the premise of special medical equipment such as a CT machine, without the need to install the entire surgical robot 3 in the CT room, thereby greatly simplifying the testing work in the research and development process, and helping to speed up the research and development of the puncture surgical robot.
[0045] like Figure 2 , Figure 3 and Figure 4As shown, the calibration plate 7 dedicated to the puncture surgical robot 3 adopts the calibration device disclosed by the inventor of the present invention in the Chinese patent application number CN 2022228558536. The bottom plate 71 of the calibration plate 7 is rectangular, and its outer diameter dimensions are 160mm*140mm*5mm in length, width and height. In order to match the outer dimensions of the bottom plate 71, the detection device 1 in the present invention includes a base 11 processed into an integral body by a thick steel plate, and preferably a stainless steel plate with a thickness of 10-20mm, a length of 280-310mm, and a width of 230-260mm is used. For example, the present invention preferably uses a stainless steel plate with a thickness of 15mm, a length of 295mm, and a width of 245mm.
[0046] A first mounting portion is provided in the middle of the base 11 for embedding the bottom plate 71 of the calibration plate 7, and a second mounting portion 17 is formed around the first mounting portion for mounting a plurality of positioning marks 15 for detection. This embodiment takes the setting of three positioning marks 15, namely A1, A2 and A3 as an example, but is not limited thereto, and the specific number of positioning marks 15 can be increased or decreased according to demand.
[0047] The second mounting portion 17 surrounds the first mounting portion inside to form a countersunk hole 12. Specifically, the first mounting portion is a rectangular countersunk hole 12 located in the middle of the base 11. The countersunk hole 12 has the same shape and outer diameter as the bottom plate 71 of the calibration plate 7, that is, the length, width and height of the countersunk hole 12 are 160mm*140mm*5mm, and the bottom plate 71 of the calibration plate 7 just fits into the countersunk hole 12. The long side of the countersunk hole 12 is parallel to the long side of the base 11, which is convenient for the conversion of coordinate values. A second through hole 14 is provided at the four corners of the bottom panel of the countersunk hole 12. When the bottom plate 71 of the calibration plate 7 is embedded in the countersunk hole 12, the support leg 70 of the calibration plate 7 just enters the corresponding second through hole 14. A first through hole 13 with a diameter of 40mm is provided in the middle of the four right-angled sides where the bottom panel of the countersunk hole 12 is connected to the second mounting portion 17. Figure 3 As shown, 1 / 3-1 / 2 of the through hole area of the first through hole 13 is located on the bottom panel of the countersunk hole 12, and the remaining through hole area is located on the second mounting portion. Preferably, the diameter of the first through hole 13 is colinear with the right-angle side of the countersunk hole 12. The diameter of the first through hole 13 is at least 35 mm, which is convenient for manually taking out and inserting the calibration plate 7 from the countersunk hole 12.
[0048] like Figure 5 , Figure 6 , Figure 7 and Figure 8As shown, the base 11 is provided with more than six test points in the second mounting portion 17, and preferably 8 are provided in this embodiment. The specific distribution is as follows: three first test points 16 are respectively provided at both ends of the long side of the second mounting portion 17, and one second test point 19 is respectively provided at both ends of the short side. The center point of the middle one of the three first test points 16 is located on the center line D of the base 11, and the two are respectively located at equidistant positions on both sides of the center line D. In this embodiment, the first test points 16 located on both sides are arranged along the long line of the long side of the countersunk hole 12, and the six first test points 16 are respectively distributed symmetrically along the two center lines of the base 11. The center points of the two second test points 19 are also located on the center line of the base 11. Such a distribution can very accurately calculate the coordinate values of the center points of each first test point 16 and each second test point 19 in the calibration plate coordinate system. The 8 test points are of the same size and shape, and are all countersunk structures, which is convenient for selecting and using the positioning mark 15 corresponding to the assembly.
[0049] like Figure 2 As shown, three positioning marks 15 are fixedly connected to the test points on the base 11 through the first base column block 20, the second base column block 21, and the third base column block 22, respectively. The positioning marks 15 connected with the second base column block 21 and the first base column block 20 are respectively located at two second test points 19 at both ends of the short side of the base 11, and the positioning mark 15 connected with the third base column block 22 is located at a first test point 16 at the middle position of one end of the long side of the base 11. All positioning marks 15 are respectively fixedly assembled on the same side of the base 11 where the countersunk hole 12 is opened through the first base column block 20, the second base column block 21, and the third base column block 22, as shown in FIG. Figure 2 After the calibration plate 7 is embedded in the countersunk hole 12 , the two relatively high columns 73 and the positioning ball 72 in the calibration plate 7 are placed close to the first base column block 20 , so that the CT machine can scan the calibration ball 72 in the calibration plate 7 and the 3D vision camera 4 can shoot the marking structure 74 in the calibration plate 7 .
[0050] The positioning mark 15 adopts the positioning piece disclosed by the creator of the present invention in Chinese patent CN2022113329810, and the specific structure will not be described in detail again.
[0051] like Fig. 9 As shown, the first base column block 20 is cylindrical, and the first end is provided with an internal threaded hole 18 for fixing the connecting piece to the second test point 19 in the base 11, and the second end is an inclined surface 24, and the inclined surface 24 is at an angle of 45 degrees to the horizontal plane. A short cylinder 23 that can be inserted into the central through hole of the positioning mark 15 is integrally formed at the center position of the inclined surface 24.
[0052] like Fig.10As shown, the second base column block 21 is cylindrical, and the first end is provided with an internal threaded hole 18 for fixing the connecting piece to the second test point 19 in the base 11, and the second end is a horizontal plane. A short cylinder 23 that can be inserted into the center through hole of the positioning mark 15 is integrally formed at the center position of the second end.
[0053] like Fig.11 As shown, the third base column block 22 is cylindrical, and the first end is provided with an internal threaded hole 18 for fixing the connecting piece to the first test point 16 in the base 11, and the second end is an inclined surface 24, and the inclined surface 24 is at an angle of 30 degrees to the horizontal plane. A short cylinder 23 that can be inserted into the central through hole of the positioning mark 15 is integrally formed at the center position of the inclined surface 24.
[0054] The steps for using the above system to detect whether the measurement accuracy of the center value of the positioning mark of the puncture surgery robot meets the requirements are as follows:
[0055] Embodiment 1
[0056] 1) Install the calibration plate 7 in the countersunk hole 12 of the detection device 1, and place the detection device 1 together with the calibration plate 7 on the test platform 6 stably. Figure 2 As shown, the two relatively high columns 73 and the positioning ball 72 in the calibration plate 7 need to be placed close to the first base column block 20, and the lower left corner point G of the calibration plate 7 is defined as the origin to establish the calibration plate coordinate system. Since the calibration plate 7 is directly installed in the countersunk hole 12 of the detection device 1 and fits the countersunk hole 12, the coordinate values of the center points of the three positioning marks 15 in the calibration plate coordinate system are fixed values, called the first coordinate values. The first coordinate values of the center points of the three positioning marks 15 are: A1 (x11, y11, z11), A2 (x21, y21, z21), A3 (x31, y31, z31).
[0057] 2) The detection device 1 is scanned together with the calibration plate 7 by the test platform 6 (CT machine). According to the corresponding relationship between the scanning data of the calibration ball 72 on the calibration plate 7 on the CT machine and the coordinate data of the calibration ball 72 in the calibration plate coordinate system, the conversion relationship ω1 between the calibration plate coordinate system and the CT machine coordinate system is obtained. According to the conversion relationship ω1, the first coordinate values of the center points of the three positioning marks 15 in the above step 1) can be converted into coordinate values in the CT machine coordinate system, which are called second coordinate values. The second coordinate values of the center points of the three positioning marks 15 are: A1 (x12, y12, z12), A2 (x22, y22, z22), A3 (x32, y32, z32).
[0058] In this step, the calibration plate 7 in the detection device 1 is scanned by the CT machine, and the one-to-one correspondence between the coordinate value of the center of the calibration sphere 72 in the calibration plate 7 in the calibration plate coordinate system and the coordinate value of the center of the calibration sphere 72 in the CT machine coordinate system is found, and then based on the one-to-one correspondence, a conversion relationship ω1 between the calibration plate coordinate system and the CT machine coordinate system is established.
[0059] 3) Install the 3D vision camera 4 (excitation device) at the end of the robot 2, run the calibration program, complete the shooting of the calibration program, obtain the conversion relationship ω2 between the calibration plate coordinate system and the robot coordinate system, and according to the conversion relationship ω1 between the calibration plate coordinate system and the CT machine coordinate system in step 2), the conversion relationship Ω between the CT machine coordinate system and the robot coordinate system can be obtained. In this step, the calibration procedure of the 3D vision camera is a prior art and will not be described in detail here.
[0060] 4) Run the measurement program of the 3D vision camera, identify and obtain the coordinate value of the center point of each group of positioning marks 15 in the mechanical arm coordinate system, and convert it into the coordinate value in the CT machine coordinate system through the conversion relationship Ω between the CT machine coordinate system and the mechanical arm coordinate system in step 3), which is called the third coordinate value; the third coordinate values of the center points of the three positioning marks 15 are: A1 (x13, y13, z13), A2 (x23, y23, z23), A3 (x33, y33, z33). The conversion relationships involved in the present invention are all mathematical relationships, which are easy to implement for technicians in the computer field, and the specific mathematical relationships are not given in detail here.
[0061] The distance deviation Di between the third coordinate value and the second coordinate value of each group of positioning marks 15 is calculated by the following formula (1), which are D1, D2, and D3 respectively.
[0062]
[0063] Wherein: i is the serial number of each group of positioning marks 15.
[0064] By judging whether the distance deviation corresponding to each group of positioning marks 15 is zero or within the allowable error range, it is possible to judge whether the measurement accuracy requirements of the center value of the positioning mark 15 are met, and whether the accuracy requirements of the 3D vision camera for measuring and identifying the center value of the positioning mark are met, thereby verifying the feasibility of using the 3D vision camera in the puncture surgery robot.
[0065] The distance deviations Di of the three groups of positioning marks 15 may be summed up and then averaged, that is, the average deviation ΔD of all distance deviations Di may be calculated by the following average deviation calculation formula (2).
[0066] ΔD=(D1+D2+D3) / 3 (2).
[0067] At the same time, the root mean square error δ of the distance deviation Di can also be calculated by the following root mean square error calculation formula (3).
[0068]
[0069] If the values of the average deviation ΔD and the root mean square error δ are both 0, it can be determined that the accuracy of the 3D vision camera in measuring and identifying the center value of the positioning mark is 100%. Of course, it is difficult to achieve 100% accuracy, so it is only necessary to determine that the average deviation ΔD and the root mean square error δ are within the allowable error range, that is, it can be determined that the accuracy of the 3D vision camera in measuring and identifying the center value of the positioning mark meets the requirements, and the feasibility of the application of the 3D vision camera in the puncture surgery robot can be verified.
[0070] Furthermore, by judging based on the average deviation ΔD and the root mean square error δ, it is possible to more accurately and scientifically judge whether the measurement accuracy of the center value of the positioning mark 15 meets the requirements.
[0071] Embodiment 2
[0072] The difference between the method of the second embodiment and the first embodiment is that the second embodiment does not require a CT machine, thereby shielding the errors caused by CT scanning and CT image recognition, and then the proportion of the errors measured by the 3D vision camera in the errors of the first embodiment can be analyzed. It is simpler, faster and more convenient than the method in the first embodiment, and has fewer conversion steps between coordinate values, better accuracy and better stability. The specific steps are as follows:
[0073] 1) Install the calibration plate 7 in the countersunk hole 12 of the detection device 1, and place the detection device 1 together with the calibration plate 7 on the test platform 6 stably. Figure 2 As shown, the two relatively high columns 73 and the positioning ball 72 in the calibration plate 7 need to be placed close to the first base column block 20, and the lower left corner point G of the calibration plate 7 is defined as the origin to establish the calibration plate coordinate system. Since the calibration plate 7 is directly installed in the countersunk hole 12 of the detection device 1 and fits the countersunk hole 12, the coordinate values of the center points of the three positioning marks 15 in the calibration plate coordinate system are fixed values, called the first coordinate values. The first coordinate values of the center points of the three positioning marks 15 are: A1 (x11, y11, z11), A2 (x21, y21, z21), A3 (x31, y31, z31).
[0074] 2) Install the 3D vision camera 4 (excitation device) at the end of the robotic arm 2, run the calibration program, complete the shooting of the calibration program, and obtain the conversion relationship ω2 between the calibration plate coordinate system and the robotic arm coordinate system. According to the conversion relationship ω2, the first coordinate value in step 1) is directly converted into the coordinate value in the robotic arm coordinate system, which is called the fourth coordinate value. The fourth coordinate values of the center points of the three positioning marks 15 are: A1 (x14, y14, z14), A2 (x24, y24, z24), A3 (x34, y34, z34).
[0075] 3) Run the measurement program of the 3D vision camera to directly identify and obtain the coordinate value of the center point of each group of positioning marks 15 in the robot arm coordinate system, which is called the fifth coordinate value; the fifth coordinate values of the center points of the three positioning marks 15 are: A1 (x15, y15, z15), A2 (x25, y25, z25), A3 (x35, y35, z35). The conversion relationships involved in the present invention are all mathematical relationships, which are easy to implement for technicians in the computer field, and the specific mathematical relationships are not given in detail here.
[0076] The distance deviation Di between the fourth coordinate value and the fifth coordinate value of each group of positioning marks 15 is calculated by the following formula (4), which are D1, D2, and D3 respectively.
[0077]
[0078] Wherein: i is the serial number of each group of positioning marks 15.
[0079] By judging whether the distance deviation corresponding to each group of positioning marks 15 is zero or within the allowable error range, it is possible to judge whether the measurement accuracy requirements of the center value of the positioning mark 15 are met, and whether the accuracy requirements of the 3D vision camera for measuring and identifying the center value of the positioning mark are met, thereby verifying the feasibility of using the 3D vision camera in the puncture surgery robot.
[0080] The distance deviations Di of the three groups of positioning marks 15 may be summed up and then averaged, that is, the average deviation ΔD of all distance deviations Di may be calculated by the following average deviation calculation formula (2).
[0081] ΔD=(D1+D2+D3) / 3 (2)
[0082] At the same time, the root mean square error δ of the distance deviation Di can also be calculated by the following root mean square error calculation formula (3).
[0083]
[0084] If the values of the average deviation ΔD and the root mean square error δ are both 0, it can be determined that the accuracy of the 3D vision camera in measuring and identifying the center value of the positioning mark is 100%. Of course, it is difficult to achieve 100% accuracy, so it is only necessary to determine that the average deviation ΔD and the root mean square error δ are within the allowable error range, that is, it can be determined that the accuracy of the 3D vision camera in measuring and identifying the center value of the positioning mark meets the requirements, and the feasibility of the application of the 3D vision camera in the puncture surgery robot can be verified.
[0085] Embodiment 3
[0086] This embodiment is basically the same as the first embodiment, except that in step 2) of this embodiment, the scan data after the CT machine scans the calibration plate 7 and the coordinate data of the calibration ball 72 in the calibration plate coordinate system are directly input into the computer 5, and the coordinate conversion relationship ω1 between the CT machine coordinate system and the calibration plate coordinate system is calculated by the computer 5. The conversion relationship ω1 between the calibration plate coordinate system and the CT machine coordinate system that has been calculated in advance can also be directly input, and the first coordinate values of the center points of the three positioning marks 15 in step 1) are directly converted into the second coordinate values in the CT machine coordinate system according to the conversion relationship ω1. Thus, the detection can be completed without special medical equipment such as a CT machine.
Claims
1. A method for detecting the measurement accuracy of the center value of the positioning mark of a puncture surgery robot is performed in the following steps: 1) Installing the calibration plate in a detection device, wherein a plurality of groups of positioning marks with different heights and placement angles are fixedly installed in the detection device, wherein each group of the positioning marks is respectively installed in a corresponding test point with a fixed position, defining the origin of the coordinate system of the calibration plate, establishing the calibration plate coordinate system, and obtaining the coordinate value corresponding to the center point of each group of the positioning marks in the calibration plate coordinate system, which is called the first coordinate value; 2) installing a 3D vision camera at the end of the robotic arm of the puncture surgery robot, running and completing a calibration program, obtaining a conversion relationship between the calibration plate coordinate system and the robotic arm coordinate system, and converting the first coordinate value into a coordinate value in the robotic arm coordinate system according to the conversion relationship, which is called a fourth coordinate value; 3) running the measurement program of the 3D vision camera to directly identify and obtain the coordinate value of the center point of each group of positioning marks in the robot arm coordinate system, which is called the fifth coordinate value; The distance deviation between the fourth coordinate value and the fifth coordinate value of each group of positioning marks is calculated, and it is determined whether the distance deviation corresponding to each group of positioning marks is zero or within the allowable error range, so as to determine whether the measurement accuracy requirement of the positioning mark center value is met.
2. The method for measuring the center value of the positioning mark of a puncture surgery robot according to claim 1 is characterized in that: After step 1), perform the following steps: 2) converting the first coordinate value of the center point of each group of positioning marks into a coordinate value in the CT machine coordinate system according to the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system, which is called the second coordinate value; 3) installing a 3D vision camera at the end of the robotic arm of the puncture surgery robot, running and completing a calibration program, obtaining a conversion relationship between the calibration plate coordinate system and the robotic arm coordinate system, and further obtaining a conversion relationship between the CT machine coordinate system and the robotic arm coordinate system based on the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system in step 2); 4) running the measurement program of the 3D vision camera, obtaining the coordinate value of each group of the center point of the positioning mark in the robot arm coordinate system, and converting it into the coordinate value in the CT machine coordinate system through the conversion relationship between the CT machine coordinate system and the robot arm coordinate system in step 3), which is called the third coordinate value; The distance deviation between the third coordinate value and the second coordinate value of each group of positioning marks is calculated, and it is determined whether the distance deviation corresponding to each group of positioning marks is zero or within the allowable error range, so as to determine whether the measurement accuracy requirement of the positioning mark center value is met.
3. The method for measuring the center value of the positioning mark of a puncture surgery robot according to claim 1 or 2, characterized in that: The distance deviations of all the positioning marks are calculated according to the following formula: Where: i is the serial number of each group of positioning marks; j and k are the coordinate values of the center point of the positioning mark obtained in different ways in the same coordinate system.
4. The method for measuring the center value of the positioning mark of a puncture surgery robot according to claim 3 is characterized in that: Add the steps of summing up the distance deviations of each group of positioning marks and then averaging them, calculating the average deviation of all distance deviations, and calculating the root mean square error of all distance deviations.
5. The method for measuring the center value accuracy of the positioning mark of a puncture surgery robot according to claim 2, characterized in that: In step 2), the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system is obtained according to the following steps: 2.1) Scanning the calibration plate in the detection device by a CT machine; 2.2) Finding a one-to-one correspondence between the coordinate value of the center of the calibration ball in the calibration plate in the calibration plate coordinate system and the coordinate value of the center of the calibration ball in the CT machine coordinate system; 2.3) Based on the one-to-one correspondence mentioned above, establish the conversion relationship between the calibration plate coordinate system and the CT machine coordinate system.
6. The method for measuring the center value of the positioning mark of a puncture surgery robot according to claim 3 is characterized in that: The placement angles of the positioning marks relative to the horizontal plane are 0 degrees, 30 degrees and 45 degrees respectively.
7. The method for measuring the center value of the positioning mark of a puncture surgery robot according to claim 3 is characterized in that: The detection device is fixedly installed with a plurality of groups of positioning marks whose heights are distributed in an arithmetic progression.
8. A system for the method according to any one of claims 1 to 7, characterized in that: The invention comprises a puncture surgery robot, a calibration plate, a test platform and a detection device. The puncture surgery robot comprises a mechanical arm, an excitation device which combines a 3D vision camera and a puncture needle into a whole, and a puncture surgery robot controller. The detection device comprises a base which is processed into an integral body by a thick steel plate, and a plurality of positioning marks of different heights and different placement angles for detection which are assembled and connected to the base.
Citation Information
Cited By
Vehicle lamp full-size online detection system and method based on mechanical arm and 3D vision
CN120947488A
