The present application claims priority to Korean Patent Application No. 10-2022-0018201, filed Feb. 11, 2022, the entire contents of which are incorporated herein for all purposes by this reference.
The present invention relates to an electromagnetic shape sensor, and more particularly, to an electromagnetic shape sensor integrated with a wire-driven robot to utilize an existing structure of a general wire-driven robot.
This study was conducted with the support from Research and Development (R&D) Fund (Main Business Fund) of the Korea Institute of Science and Technology funded by the Ministry of Science and ICT of Korea, and the project title is [MIDAS Original Technology Development to Lead the Era of Surgery 4.0, Project No. 1711152122, Detailed Project No. 2E31070].
Minimum invasive surgery refers to surgery that is performed while minimizing an incision site without performing laparotomy. The advantage of the minimum invasive surgery is that there is almost no scar or sequelae, little bacterial infection exposure occurs, and fast recovery is enabled because the incision site is small. Because a surgical device in the related art has a hard and fixed structure, there is a problem in that it is difficult to search an interior of a human body without causing wounds in surrounding tissue. In addition, a wire-driven robot has been proposed to overcome the restriction on the surgical device in the related art and is used for the minimum invasive surgery.
It is necessary to detect, in real time, a shape of the invading wire-driven robot during three-dimensional surgery using the wire-driven robot. To this end, shape sensors disclosed in U.S. patent Ser. No. 10/226,304 B2 (Patent Document 1) and U.S. Patent Application Publication No. 2020-0146757 A1 (Patent Document 2) have been proposed.
Patent Document 1 discloses a technology using an optical fiber sensor, particularly, a fiber Bragg grating (FBG) based sensor. The FBG sensor is sensitive to a change in temperature, a large amount of cost is required for an interrogator to measure the FBG sensor, and high precision is required to assemble a sensor fiber to a continuous body robot body in consideration of the alignment of fibers and efficiency in transmitting deformation in a cross-section of a continuous body robot, which causes a problem of very high manufacturing difficulty.
Patent Document 2 discloses a technology using an EM sensor using electromagnetic tracking. Patent Document 2 discloses a configuration in which an external magnetic field generator additionally configured together with a wire-driven robot is used to sense a shape of a wire-driven robot. For this reason, there are problems in that a set-up magnitude of an entire device increases, and the device is affected by noise caused by peripheral metal devices.
The present invention has been made in an effort to solve the above-mentioned problems, and an object of the present invention is to provide an electromagnetic shape sensor integrated with a wire-driven robot to utilize a structure of the wire-driven robot in the related art.
An exemplary embodiment of the present invention provides an electromagnetic shape sensor, which is configured to sense a shape of a wire-driven robot including a tube extending in one direction, a plurality of wires configured to steer the tube, and a body configured to accommodate the tube and the plurality of wires, the electromagnetic shape sensor including: an excitation coil configured to surround at least a part of an outer peripheral surface of the tube; and a plurality of sensing coils corresponding to the plurality of wires and configured to each surround at least a part of an outer peripheral surface of the corresponding wire.
Another exemplary embodiment of the present invention provides a wire-driven continuous body robot with which an electromagnetic shape sensor is integrated, the wire-driven continuous body robot including: a tube extending in one direction; a plurality of wires configured to steer the tube; a plurality of disks connected to one another in series and connected to be rotatable about a rotation axis, the plurality of disks each including a central opening penetrated by the tube, and a plurality of circumferential openings disposed to have different centers from the central opening, spaced apart from one another in a circumferential direction, and penetrated by the plurality of wires; an excitation coil configured to surround at least a part of an outer peripheral surface of the tube; and a plurality of sensing coils configured to each surround at least a part of an outer peripheral surface of each of the plurality of wires.
The electromagnetic shape sensor integrated with a wire-driven robot according to the embodiment of the present invention uses the magnetic field method, which makes it possible to provide excellent living body compatibility, durability, and heat resistance in virtue of characteristics of the copper coil. In addition, it is possible to use the existing space of the wire-driven robot in the related art without change and easily perform the installation and operation without the necessity of other external devices.
The electromagnetic shape sensor integrated with a wire-driven robot according to the embodiment of the present invention may estimate the shape of the wire-driven robot through the prediction model configured to estimate the rotation angle and the bending angle of the wire-driven robot on the basis of the difference in voltage between the sensing coils symmetrically disposed. Therefore, it is possible to provide the more accurate results and implement robustness by using the difference in induced voltage between the sensing coils 110 even though disturbing metal is present inside or outside of the electromagnetic shape sensor.
The effects obtained by the present invention are not limited to the aforementioned effects, and other effects, which are not mentioned above, will be clearly understood by those skilled in the art from the following description.
Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings. The present invention will be described with reference to the embodiment illustrated in the drawings, but the description of the present invention is made as one embodiment. The technical spirit and the key components and operations of the present invention are not limited by the embodiment.
Referring to
The excitation coil 100 may generate a magnetic field in response to applied power. The sensing coil 110 may generate induced voltage in response to the magnetic field applied to the excitation coil 100. The power source 120 is configured to supply power to the excitation coil 100 and sense the induced voltage of the sensing coil 110. In addition, on the basis of the sensed induced voltage, the shape predictor 140 predicts a shape of a device to which the electromagnetic shape sensor 10 is applied. The electromagnetic shape sensor 10 according to the embodiment of the present invention may be a sensor configured to sense a shape of a wire-driven robot. The shape predictor 140 may be configured to predict the shape of the wire-driven robot.
Referring to
The tube 200 may be made of a flexible material and bent by a tensile force of the wires. For example, the tube 200 may be, but not limited to, a silicone tube. The plurality of wires 210 may be configured to steer the tube 200. The plurality of wires 210 may be symmetrically disposed with respect to the tube 200. For example, as illustrated in
The body 220 is configured to accommodate the tube 200 and the wires 210. The wire 210 may be disposed in the body 220. In a state in which one end of the wire 210 is fixed, the other end of the wire 210 may be coupled to a device, such as a pulley, configured to adjust a length of the wire. Therefore, the length of the wire 210 may be adjusted. That is, the wire 210 may serve as a tendon. The tube 200 may be bent by a change in length of the wire 210, such that an overall shape of the wire-driven robot 20 may be changed.
The body 220 includes a plurality of disks connected in series and configured to be rotatable about a rotation axis. Referring to
In this case, the electromagnetic shape sensor 10 may be integrated with the wire-driven robot 20. The electromagnetic shape sensor 10 may be disposed on the entire wire-driven robot 20, but the present invention is not limited thereto. The electromagnetic shape sensor 10 may be disposed partially at a position and region of the wire-driven robot 20 where the shape of the wire-driven robot 20 is required to be measured.
Specifically, the excitation coil 100 may be configured to surround at least a part of the outer peripheral surface of the tube 200. The excitation coil 100 may extend in an extension direction of the tube 200 while surrounding at least a part of the outer peripheral surface of the tube 200. The plurality of sensing coils 110 corresponds to the plurality of wires 210. Each of the sensing coils 110 may surround at least a part of an outer peripheral surface of the corresponding wire 210. Each of the sensing coils 110 may extend in an extension direction of the wire 210 while surrounding at least a part of the outer peripheral surface of the corresponding wire 210. The plurality of sensing coils 110 may be symmetrically positioned with respect to the excitation coil 100. In this case, when the four wires 210 are provided to correspond to the four directions, the sensing coils 110 may also be provided to correspond to the four wires 210. As illustrated in
In
In a state in which the tube 200 is not bent, a magnetic field is generated by the excitation coil 100 is shown as
Depending on the change in magnetic field, there occurs a difference between the induced voltages applied to the sensing coils 110 disposed symmetrically with respect to the excitation coil 100.
The measurer 130 may measure the induced voltage measured by the sensing coils 110 disposed symmetrically with respect to the excitation coil 100. The measurer 130 may be configured to measure the voltages of the plurality of sensing coils 110 and provide the measured to the shape predictor 140.
The shape predictor 140 may predict the shape of the wire-driven robot 20 on the basis of the induced voltage provided from the power source 120. Specifically, the plurality of sensing coils 110 may include the sensing coils disposed symmetrically with respect to the X-axis on the X-Y plane, which is defined such that the center of the cross-section of the tube 200 is defined as the origin of the X-Y plane, and the sensing coils disposed symmetrically with respect to the Y-axis on the X-Y plane. When the four sensing coils 110 are provided, the two sensing coils may be disposed symmetrically with respect to the X-axis, and the remaining two sensing coils may be disposed symmetrically with respect to the Y-axis. The shape predictor 140 may predict the shape of the wire-driven robot 20 on the basis of a difference (Sigx) in induced voltage between the sensing coils disposed symmetrically with respect to the X-axis and a difference (Sigy) in voltage between the sensing coils disposed symmetrically with respect to the Y-axis. That is, the shape of the wire-driven robot 20 is estimated by using a difference value between the symmetrically disposed sensing coils instead of using a simply measured induced voltage. Therefore, it is possible to prevent the occurrence of error in a situation in which the induced voltage is changed by an external magnetic field.
Specifically, the shape predictor 140 may include a first prediction model configured to predict a rotation angle φ and a bending angle θ of the wire-driven robot 20 on the basis of the difference (Sigx) in induced voltage between the sensing coil disposed symmetrically with respect to the X-axis, and a second prediction model configured to predict a rotation angle φ and a bending angle θ of the wire-driven robot 20 on the basis of a difference (Sigy) in induced voltage between the sensing coils disposed symmetrically with respect to the Y-axis. The first prediction model may be a prediction model established in advance on the basis of experimentally measured data sets (input data: Sigx, output data: rotation angle φ and bending angle θ). The second prediction model may be a prediction model established in advance on the basis of experimentally measured data sets (input data: Sigy, output data: rotation angle φ and bending angle θ). Each of the first and second prediction models may be established through at least one analysis model among a linear regression model, a logistic regression model, a machine learning model, and a neural network model.
The shape predictor 140 may create prediction shape information used to predict the shape of the wire-driven robot 20 in consideration of the predicted rotation angle φ, the predicted bending angle θ, and basic information (an overall length, a diameter, etc.) of the wire-driven robot 20.
The electromagnetic shape sensor 10 and the wire-driven robot 20 were configured on the basis of a condition as shown in Table 1. The wire-driven robot 20 was configured as a continuous body drive robot in which disks were connected in series as illustrated in
An experiment was performed to check the performance of the electromagnetic shape sensor 10 integrated with the wire-driven robot 20 configured according to the embodiment, specifically, the performance of the first and second prediction models.
The first and second prediction models were established through the multivariate linear regression model so as to predict the rotation angle φ and the bending angle θ of the wire-driven robot 20 on the basis of the inputted Sigx and Sigy.
In addition,
An experiment was performed to check the performance of the electromagnetic shape sensor 10 integrated with the wire-driven robot 20 configured according to the embodiment, specifically, the performance of the electromagnetic shape sensor 10 for predicting the shape.
An experiment was performed to check that the electromagnetic shape sensor 10 integrated with the wire-driven robot 20 configured according to the embodiment has durability against disturbance of the magnetic field.
The surgery using the wire-driven robot 20 uses various metallic tools such as cutter, forceps, pincers, and wires inside and outside the robot. When a conductive metal object is present in a magnetic field that varies over time, the disturbance of the magnetic field may occur. Therefore, it is necessary to evaluate firmness and robustness of the proposed sensor against disturbance of electromagnetic waves caused by the metal object.
First, an experiment was performed on the disturbance of the magnetic field that occurred when nitinol and steel passed through the interior of the robot. In the experimental example, a steel wire and a nitinol wire, which each had a diameter of 0.5 mm, were inserted into the tube through the central opening through 7 divided steps, and Sigx, which was the difference in induced voltage between the sensing coil changing depending on and corresponding to the induced voltage, was measured in each step. For example, in step 1, the disturbing metal is present outside the tube. In step 2, the disturbing metal is present at the end of the excitation coil. In next step, the disturbing metal is inserted by ¼ of the length of the excitation coil. Then, in step 6, the disturbing metal is completely inserted into the excitation coil. In step 7, the disturbing metal passes through the tube.
The electromagnetic shape sensor integrated with a wire-driven robot according to the embodiment of the present invention uses the magnetic field method, which makes it possible to provide excellent living body compatibility, durability, and heat resistance in virtue of characteristics of the copper coil. In addition, it is possible to use the existing space of the wire-driven robot in the related art without change and easily perform the installation and operation without the necessity of other external devices.
The electromagnetic shape sensor integrated with a wire-driven robot according to the embodiment of the present invention may estimate the shape of the wire-driven robot through the prediction model configured to estimate the rotation angle and the bending angle of the wire-driven robot on the basis of the difference in voltage between the sensing coils symmetrically disposed. Therefore, it is possible to provide the more accurate results and implement robustness by using the difference in induced voltage between the sensing coils 110 even though disturbing metal passes through the electromagnetic shape sensor.
Another exemplary embodiment of the present invention provides a wire-driven robot with which an electromagnetic shape sensor is integrated, the wire-driven robot including: a tube extending in one direction; a plurality of wires configured to steer the tube; a plurality of disks connected to one another in series and connected to be rotatable about a rotation axis, the plurality of disks each including a central opening penetrated by the tube, and a plurality of circumferential openings disposed to have different centers from the central opening, spaced apart from one another in a circumferential direction, and penetrated by the plurality of wires; an excitation coil configured to surround at least a part of an outer peripheral surface of the tube; and a plurality of sensing coils configured to each surround at least a part of an outer peripheral surface of each of the plurality of wires.
In the above-mentioned specific embodiments, the components included in the invention have been expressed as singular or plural components depending on the proposed specific embodiments. However, the singular or plural expression is appropriately selected for the situation proposed for the convenience of description, and the above-mentioned embodiments are not limited by the singular or plural expression. Therefore, the component expressed with a plural term may be configured in a singular form, or the component expressed with a singular term may be configured in a plural form.
While the specific embodiments according to the present invention have been described above, various modifications may be made without departing from the scope of the present invention contained in the various embodiments. Therefore, the scope of the present invention should not be limited to the described exemplary embodiments, and should be defined by not only the claims to be described below, but also those equivalent to the claims.
Number | Date | Country | Kind |
---|---|---|---|
10-2022-0018201 | Feb 2022 | KR | national |