1. Field of the Invention
The present invention relates to a medical equipment system provided with a medical instrument used while projecting from a distal end of an insertion portion of an endoscope inserted into the body of a subject and a medical instrument calibration method, and more particularly, to a medical equipment system and a medical instrument calibration method capable of detecting a precise direction of the distal end portion of the medical instrument.
2. Description of the Related Art
In recent years, an insertion navigation system is disclosed which forms a three-dimensional image of a tube, for example, the bronchus of the lung from three-dimensional image data of a subject obtained using a CT apparatus, determines a path up to a target point along the tube on the three-dimensional image and further forms a virtual endoscope image of the tube along the path based on the three-dimensional image data. Using, for example, an insertion navigation system disclosed in Japanese Patent Application Laid-Open Publication No. 2004-180940 allows an operator to correctly guide the distal end of the insertion portion of an endoscope to the vicinity of a region of interest in a short time. However, there is a limit to the thickness, that is, the diameter, of the tube through which the insertion portion can be inserted, and the insertion portion cannot be inserted up to the periphery of the bronchus. For this reason, after the distal end of the insertion portion reaches the vicinity of the region of interest, by causing a medical instrument such as treatment instrument or ultrasound probe of a smaller diameter to project from the distal end of the insertion portion, the operator can extract a sample of the region of interest or photograph an ultrasound image of target tissue.
To photograph an ultrasound image of target tissue or extract a sample of the region of interest, it is necessary to detect the position and direction of the distal end portion of the medical instrument. Japanese Patent Application Laid-Open Publication No. 2006-223849 and Japanese Patent Application Laid-Open Publication No. 2007-130154 propose a method of arranging a sensor at the distal end portion of the medical instrument to detect the position and direction of the distal end portion of a medical instrument.
A medical equipment system according to the present invention is provided with an insertion portion having a rigid portion disposed at a distal end portion of the insertion portion, a medical instrument whose medical instrument distal end portion projects from a projection port of the rigid portion, a channel that passes through the rigid portion and can linearly support the medical instrument distal end portion in the rigid portion, and a direction calculation section that calculates a longitudinal direction of the medical instrument distal end portion based on a positional variation caused by linear movement of the medical instrument distal end portion in the channel in the rigid portion.
Furthermore, another medical instrument calibration method of the present invention for a medical equipment system provided with an insertion portion having a rigid portion disposed at a distal end portion of the insertion portion, a medical instrument whose medical instrument distal end portion projects from a projection port of the rigid portion and a channel that passes through the rigid portion and can linearly support the medical instrument distal end portion in the rigid portion, includes an insertion step of inserting the medical instrument from an insertion port of the channel on a proximal end portion side, a first calculation step of calculating the position of the medical instrument distal end portion in a first place in the channel in the rigid portion based on information of a first sensor disposed at the medical instrument distal end portion, capable of detecting a position and a direction, a probe moving step of moving the position of the medical instrument distal end portion from the first place to a second place in the channel in the rigid portion on a straight line, a second calculation step of calculating the position of the medical instrument distal end portion in the second place, and a distal end portion direction calculation step of calculating the direction of the medical instrument distal end portion based on the position calculated in the first calculation step and the position calculated in the second calculation step.
Hereinafter, an endoscope system 1, which is a medical equipment system according to a first embodiment of the present invention, and a calibration method of an ultrasound probe (hereinafter also simply referred to as “probe”) 21 of a small diameter, which is a medical instrument, will be described with reference to the accompanying drawings.
As shown in
Next, as shown in
The ultrasound observation apparatus 20 has a probe 21 having an ultrasound transducer 23 at a probe distal end portion (hereinafter also simply referred to as “distal end portion”) 22, which is a medical instrument distal end portion, an ultrasound observation unit 24 that controls the ultrasound transducer 23 and processes an ultrasound signal obtained and a monitor 25 that displays an ultrasound image.
The navigation apparatus 30 has transmission antennas 33 which are magnetic field generating means for generating magnetic fields for a first sensor 40 disposed at the distal end portion 22 and a second sensor 41 disposed in the rigid portion 13 of the insertion portion 12 to detect the position and direction, a sensor unit 32 that processes output data of the first sensor 40 and the second sensor 41, a navigation unit 31 that calculates positions and directions of the distal end portion 22 of the probe 21 and the distal end of the insertion portion 12 based on information of the sensor unit 32 and is insertion supporting means for supporting the insertion operation, and a monitor 34 that performs display for navigation. The sensor unit 32 and the navigation unit 31 need not be independent units, but may be integrated in one single unit.
The sensor unit 32 shown in
That is, as shown in
Therefore, the first sensor 40 can detect distances from and directions of the respective coils located at a plurality of different positions in the transmission antennas 33. Thus, the sensor unit 32 can detect a position (x, y, z) and a direction (α, β, γ) of the first sensor 40 using the positions of the transmission antennas 33 as references, that is, parameters of six degrees of freedom. The sensor position is, for example, three-dimensional coordinate values of the coil center point of the coils 40A and 40B and the sensor direction is the direction of, for example, the coil axis of the coil 40A.
As shown in
The sensor unit 32 detects the positions and directions of the first sensor 40 and the second sensor 41 and calculates the position and direction of the ultrasound transducer 23 disposed at the distal end portion 22. The navigation unit 31 then performs navigation based on the positions and directions of the ultrasound transducer 23 and the distal end portion 22 calculated by the sensor unit 32. The position of the ultrasound transducer 23 is, for example, the center position of the ultrasound transducer 23, the direction thereof is a direction orthogonal to the direction in which ultrasound is generated, and the position of the distal end portion 22 is the center position of the distal end face of the probe 21 and the direction thereof is the longitudinal direction of the elongated distal end portion 22.
However, as shown in
As shown in
Here,
As will be described later, the direction calculation section 31B calculates the longitudinal direction of the distal end portion 22 based on the place to which the distal end portion 22, that is, the first sensor 40 moves on a straight line, for example, the position of the first sensor 40 before and after the movement when the channel 14 in the rigid portion 13 is moved, and thereby calculates the amount of difference between the magnetic field detection direction of the coil 40A and the longitudinal direction of the distal end portion 22, the direction correction section 31C corrects the direction detected by the first sensor 40 and calculates the longitudinal direction of the distal end portion 22, and the endoscope system 1 can thereby calculate the direction with high accuracy.
Here, the operation of the endoscope system 1 will be described using
<Step S10> Insertion Portion Insertion Step
The operator inserts the insertion portion 12 of the endoscope apparatus 10 into the bronchus 7 of the subject 5. In that case, by forming a virtual endoscope image of the bronchus 7 using a publicly known insertion navigation system based on the three-dimensional image data and performing insertion support, the operator can correctly guide the distal end of the insertion portion 12 to the vicinity of the region of interest 8 in a short time.
<Step S11> Probe Insertion Step
As shown in
<Step S12> First Calculation Step
The operator instructs the navigation unit 31 on the first direction correction processing.
Upon receiving the instruction on the first direction correction processing, the navigation unit 31 acquires data (position and direction) of the first sensor 40 and the second sensor 41 from the sensor unit 32.
In this case, suppose the position data of the second sensor 41 is P1, the axial direction data is vector V1, radial direction data is vector W1, the magnetic field detection direction data of the coil 40A of the first sensor 40 is vector V2, and the magnetic field detection direction data of the coil 40B is vector W2.
<Step S13> Probe Moving Step
Next, as shown in
<Step S14> Second Calculation Step
The operator instructs the navigation unit 31 on second direction correction processing.
Upon receiving the instruction of the second direction correction processing, the navigation unit 31 acquires data (position and direction) of the second sensor 41 and data (position and direction) of the first sensor 40 form the sensor unit.
In this case, suppose the position data of the second sensor 41 is P3, the axial direction data is vector V3, radial direction data is vector W3, magnetic field detection direction data from the coil 40A of the first sensor 40 is vector V4, and magnetic field detection direction data from the coil 40B is vector W4.
<Step S15> Correction Coefficient Calculation Step
Assuming that the moving direction of the probe 21 coincides with the longitudinal direction of the distal end portion 22 of the probe 21, the navigation unit 31 estimates the longitudinal direction of the distal end portion 22 of the probe 21. However, while the probe 21 is moving, the endoscope 11 may move due to movement, breathing or heart beat of the subject. To cancel out the movement of the endoscope 11, it is preferable to calculate the moving direction of the probe 21 as the longitudinal direction of the distal end portion 22 of the probe 21 based on the relative position of the probe 21 with respect to the endoscope 11.
The method of calculating the longitudinal direction VV of the distal end portion 22 will be described in (Equation 1) to (Equation 6) described below.
First, the navigation unit 31 sets vector X1, vector X3 and vector X4 as (Equation 1), (Equation 2) and (Equation 3) below respectively.
X1=V1×W1 (vector product) (Equation 1)
X3=V3×W3 (vector product) (Equation 2)
X4=V4×W4 (vector product) (Equation 3)
Next, assuming the relative position of the probe 21 with respect to the endoscope 11 in the first calculation step before moving the probe is vector P1P2 from P1 to P2, relative position coefficients a, b and c are calculated when expressed by (Equation 4) below using V1, W1 and X1.
P2P1=aV1+bW1+cX1 (Equation 4)
Likewise, assuming the relative position of the probe 21 relative to the endoscope 11 in the second calculation step after moving the probe is vector P1P2 from P3 to P4, relative position coefficients a1, b1 and c1 are calculated when expressed by (Equation 5) below using V3, W3 and X3.
P4P3=a1V3+b1W3+c1X3 (Equation 5)
The axial direction of the probe 21 in the second calculation step, that is, the longitudinal direction VV of the distal end portion 22 is calculated from the moving direction of the probe 21, and is calculated based on the relative position with respect to the endoscope 11. Thus, VV can be calculated as expressed in (Equation 6) below using a, b, c, a1, b1 and c1 which are relative position coefficients.
VV=P3P4−P1P2=(a1−a)V3+(b1−b)W3+(c1−c)X3 (Equation 6)
The longitudinal direction VV of the distal end portion 22 of the probe 21 calculated here is expressed as a function of magnetic field detection direction data of the coil 40A which is output data of the first sensor 40 and magnetic field detection direction data of the coil 40B. By expressing VV with this function, the output data of the first sensor 40 of the probe 21 is corrected and a correction coefficient for accurately calculating the longitudinal direction of the distal end portion 22 is calculated.
When VV is expressed as a function of V4, W4 and X4, VV is expressed by (Equation 7) below and the navigation unit 31 can calculate a2, b2 and c2 which are correction coefficients using (Equation 6) and (Equation 7).
VV=a
2
V4+b2W4+c2X4 (Equation 7)<
<Step S16> Detection Direction Correction Step (Navigation Step)
The navigation apparatus 30 changes the navigation target from the rigid portion 13 of the insertion portion 12 to the distal end portion 22 of the probe 21. The navigation apparatus 30 creates navigation information based on the corrected longitudinal direction VV(t) of the distal end portion 22 and the detected position of the distal end portion 22. The operator inserts the probe 21 up to the vicinity of the region of interest 8 according to navigation information of the navigation apparatus 30 and performs observation using the ultrasound transducer 23.
As shown in
VV(t)=a2V(t)+b2W(t)+c2(V(t)×W(t)) (Equation 8)
<Step S17> End Instruction
The navigation apparatus 30 continues the navigation until the operator sends an end instruction.
The correction coefficients a2, b2 and c2 used by the direction correction section 31C for correction are values specific to the probe 21. Therefore, the navigation apparatus 30 also has a storage section that stores the relationship between the probe whose correction coefficient is calculated once, in other words, the calibrated probe and the correction coefficient, and it is also possible to preferably use an endoscope system that informs the operator that the correction coefficient has already been calculated when the probe stored in the storage section is used.
An example has been described above where the position of the distal end portion 22 is corrected based on information of the second sensor 41. Even when the relative position of the bronchus 7 with respect to the region of interest 8 of the distal end portion 22 does not change, the position of the distal end portion 22 changes due to breathing or the like of the subject 5. However, in the case of movement of the distal end portion 22 due to breathing or the like of the subject 5, it is possible to assume that the second sensor 41 also simultaneously moves by the same amount. Thus, by correcting the position of the distal end portion 22 based on the information of the second sensor 41, it is possible to estimate the movement due to breathing or the like of the subject 5 and calculate the position of the distal end portion 22 more accurately.
When the region of interest 8 is located at a region where there is little influence of breathing or the like of the subject, the position of the distal end portion 22 need not be corrected based on the information of the second sensor 41. In other words, the second sensor 41 is unnecessary.
Although the ultrasound probe 21 has been illustrated above as an example of the medical instrument, the medical instrument is not limited to this, but a treatment instrument such as puncture needle, brush or forceps whose distal end is suitable for sampling of tissue may be used as the medical instrument.
As described so far, in the endoscope system 1 which is the medical equipment system of the present embodiment, when the first sensor 40 is disposed at the probe 21, even if the probe 21 is not disposed accurately, the probe 21, which is the medical instrument, calibrates the probe 21, and can thereby detect a precise longitudinal direction of the distal end portion 22. Thus, the endoscope system 1 can perform high accuracy inspection or treatment.
Furthermore, a magnetic field sensor made up of two coils whose coil axes are orthogonal to each other as the first sensor 40 and second sensor 41 has been illustrated in the present embodiment, but these need not be orthogonal to each other as long as the coil axis directions of the two coils are different. Furthermore, the magnetic field sensor may be made up of three or more coils or may be an MR sensor, MI sensor, FG sensor or the like.
Hereinafter, an endoscope system 1B which is a medical equipment system according to a second embodiment of the present invention will be described with reference to the accompanying drawings. The endoscope system 1B of the present embodiment is similar to the endoscope system 1 of the first embodiment, and therefore the same components will be assigned the same reference numerals and descriptions thereof will be omitted.
As shown in
However, as shown in
That is, the first calculation step is performed in the state shown in
That is, the endoscope system 1B of the present embodiment and the endoscope system 1 of the first embodiment only differ in the place where calibration is performed, but are basically the same in the system configuration and calibration method.
Even in the case of a side-viewing endoscope or oblique-viewing endoscope having a structure in which the probe 21 projects in the diagonal direction as in the case of the endoscope 11B, the endoscope system 1B of the present embodiment can obtain effects similar to those of the endoscope system 1B of the first embodiment.
Hereinafter, an endoscope system 1C which is a medical equipment system according to a third embodiment of the present invention will be described with reference to the accompanying drawings. The endoscope system 1C of the present embodiment is similar to the endoscope system 1 of the first embodiment, and therefore the same components will be assigned the same reference numerals and descriptions thereof will be omitted.
In the endoscope system 1C, as shown in
A direction calculation section 31BA which is different from the direction calculation section 31B of the first embodiment calculates the longitudinal direction of the distal end portion 22 of the probe 21 with respect to the direction of the second sensor 41 based on the shape of the probe 21 in the endoscope image 18A first.
There are several methods thereof and two of those methods will be described. A first method will be described below first. According to the first method, the endoscope image 18A is preliminarily photographed with the probe 21 projected in various projection directions and projection lengths, the direction of the distal end 22A of the probe 21 with respect to the direction of the second sensor 41 at that time is physically measured and a database is created according to the following procedure. The portion corresponding to the probe 21 and the other portion in each endoscope image 18A are identified, binarized and a binarized reference endoscope image is thereby created. At the time of photographing an endoscope image, the binarized reference endoscope image and the measured distal end direction of the probe 21 are associated with each other and saved, and a database is thereby created.
During use, an outer edge shape of the probe 21 is extracted from the current endoscope image 18A. The positions and shapes of the probe 21 are compared using the outer edge shape of the probe 21 extracted from the endoscope image 18A, a plurality of binarized reference endoscope images saved in the database and the endoscope image, a binarized reference endoscope image that best matches the position and shape of the probe 21 of the current endoscope image 18A is selected. The longitudinal direction of the distal end portion 22 associated with the selected binarized reference ultrasound image is assumed to be the longitudinal direction of the distal end portion 22 corresponding to the direction of the current second sensor 41.
Next, the second method will be described. In the second method, the outer edge shape of the probe 21 is extracted from the current endoscope image 18A during use. As shown in
Furthermore, lengths of the reference line segments 53 and 54 are calculated and assumed to be the values of z. Next, since the value of the angle of view which is a design value of the endoscope and the value of the outer diameter of the distal end portion 22 which is a design value of the probe 21 are known, it is possible to judge an approximate apparent outer diameter of the probe 21 on the endoscope image 18A in proportion to the distance between the probe 21 and the CCD 19. In other words, when the probe 21 is far from the CCD 19, its endoscope image 18A appears small and when the probe 21 is in the vicinity, its endoscope image 18A appears large. Thus, it is possible to calculate the distance between the CCD 19 in the three-dimensional space and the reference points 50 and 51 on the probe 21 from the values of z. On the other hand, it is possible to judge the direction of the (x, y) coordinates on the endoscope image 18A with respect to the CCD 19 in the three-dimensional space from the value of the angle of view which is a design value of the endoscope. To be exact, the (x, y) coordinate points on the endoscope image correspond to points on radial straight lines centered on the position of the CCD 19 in the three-dimensional space. From this, it is possible to calculate the directions of the reference points 50 and 51 on the probe 21 from the CCD 19 in the three-dimensional space from the (x, y) values. The positions of the reference points 50 and 51 of the probe 21 with respect to the CCD can be calculated from the distances between the CCD 19 and the reference points 50 and 51 on the probe 21 calculated from z described above, the directions of the reference points 50 and 51 on the probe 21 from the CCD 19 in the three-dimensional space calculated from (x, y).
Furthermore, the three-dimensional positional relationship between the CCD 19 and the second sensor 41 is known. For this reason, it is possible to convert the positions of the reference points 50 and 51 of the probe 21 with respect to the CCD 19 to positions of the reference points 50 and 51 of the probe 21 with respect to the second sensor 41 when assuming the position of the second sensor 41 is the origin and the directions of the second sensor 41 are x-, y- and z-axes. The direction of the vector connecting the two reference points on the probe 21 is the longitudinal direction of the distal end portion 22, and the longitudinal direction of the distal end portion 22 with respect to the direction of the second sensor 41 can be calculated.
Next, the direction calculation section 31B converts the longitudinal direction of the distal end portion 22 with respect to the direction of the second sensor 41 to the longitudinal direction of the distal end portion 22 with respect to the direction of the first sensor 40. That is, the direction calculation section 31B performs coordinate transformation from the detection value of the first sensor 40 and the detection value of the second sensor 41 using the relationship between the position and direction of the first sensor 40 and the position and direction of the second sensor 41.
Next, a processing flow of the endoscope system 1C of the present embodiment will be described according to the flowchart in
<Steps S20 and S21>
These are the same as steps S10 and S11 in the description of the endoscope system 1 according to the first embodiment.
<Step S22> Projection Step
The operator causes the probe 21 to project from the projection port 14B up to a sufficiently recognizable position in the endoscope image 18A as shown in
<Step S23> Distal End Portion Direction Calculation Step
The navigation unit 31 performs image analysis of the state of the probe 21 in the endoscope image 18A using the aforementioned method and thereby calculates the longitudinal direction VV of the distal end portion 22 of the probe 21 with respect to the second sensor 41. In this case, VV is calculated using the direction of the second sensor 41 as shown in (Equation 9) as a reference.
The navigation unit 31 acquires direction data of the second sensor 41 simultaneously with the distal end portion direction calculation step. Of the direction data of the second sensor in this case, the longitudinal direction data of the distal end portion 22 (rigid portion 13) is assumed as a vector V6 and the direction data on the endoscope image 18A is assumed as a vector W6.
VV=a
4
V6+b4W6+c4X6 (Equation 9)
where
X6=V6×W6 (vector product) (Equation 10)
<Step S24> Correction Coefficient Calculation Step
The navigation unit 31 acquires magnetic field detection direction data of the first sensor 40 simultaneously with the distal end portion direction calculation step. Suppose magnetic field detection direction data of the coil 40A of the first sensor 40 is a vector V5 and the magnetic field detection direction data of the coil 40B is a vector W5 in this case.
VV is expressed as a function of V5, W5 and X5 as (Equation 11) below. Relative position coefficients a5, b5 and c5 can be calculated from VV calculated according to (Equation 9) and the detected values of V5, W5 and X5.
VV=a
5
V5+b5W5+c5X5 (Equation 11)
<Step S25> Detection Direction Correction Step
The detection direction correction step of the endo scope system 1C is the same as the detection direction correction step S16 of the endoscope system 1 of the first embodiment.
The endo scope system 1C of the present embodiment has the effects of the endoscope system 1 of the first embodiment and can further detect the longitudinal direction of the distal end portion 22 of the probe accurately even when the probe 21 is bent due to influences of gravity or the like.
Hereinafter, an endoscope system 1D according to a fourth embodiment will be described with reference to the accompanying drawings. The endoscope system 1D of the present embodiment is similar to the endoscope system 1 of the first embodiment, and therefore the same components will be assigned the same reference numerals and descriptions thereof will be omitted.
In navigation, it is important to accurately detect the longitudinal direction of the distal end portion 22 of the medical instrument of a small diameter to be made to project from the insertion portion of the endoscope as in the case of the endoscope system 1 of the first embodiment, and at the same time, it is also important to accurately detect a reference azimuth which is a predetermined azimuth within a plane (radial direction) perpendicular to the longitudinal direction. When, for example, the medical instrument is an ultrasound probe which radially scans a plane perpendicular to the longitudinal axis of the probe, detecting the vertical and horizontal directions within the scanning plane of the ultrasound transducer is important in judging the position of a lesioned region. Furthermore, when the medical instrument is forceps, it is important and necessary that the opening/closing direction of the forceps match the direction of the lesioned region.
Therefore, when, for example, a sensor made up of two coils, directions of coil axes of which are orthogonal to each other, is disposed at the distal end portion 22 of the ultrasound probe 21, it is ideal to ensure that the magnetic field detection direction of one coil be parallel to the longitudinal direction of the distal end portion 22 of the ultrasound probe 21 and the magnetic field detection direction of the other coil be parallel to the reference azimuth (e.g., upward direction of the ultrasound image).
However, as has already been described, it is not easy to dispose on the distal end portion 22 of the probe 21 of an extremely small diameter, a two-axis magnetic field sensor of a still smaller diameter so that one detection axis thereof is parallel to the longitudinal direction of the distal end portion 22 and the other detection axis is parallel to the upward direction of the ultrasound image. Thus, as shown in
For this reason, the endoscope system 1D detects variations in the position and direction of the sensor 40 due to a rotation operation of the probe 21 and the direction calculation section 31B calculates the exact longitudinal direction of the distal end portion 22. On the other hand, variations in the position and direction of the sensor 40 due to a bending operation of the bending portion 12A of the probe 21 (see
As shown in
As shown in
Next, sections in the navigation unit 31Z of the endoscope system 1D of the present embodiment will be described. Since the position calculation section 31A is the same as that of the first embodiment, the direction calculation section 31B will be described first.
First, the operator twists the probe 21 in the channel 14 in such a way that the bending portion 12A as shown in
(U(t0), V(t0), W(t0)) and (U(t1), V(t1), W(t1)) can be expressed using matrices S(t0) and S(t1) of three rows and three columns respectively as follows. The respective components of S(t0) and S(t1) are successively outputted from the sensor unit 32.
[i(t0)j(t0)k(t0)]=[U(t0)V(t0)W(t0)]S(t0) (Equation 12)
[i(t1)j(t1)k(t1)]=[U(t1)V(t1)W(t1)]S(t1) (Equation 13)
Here, S(t0) and S(t1) can be expressed as (Equation 14) and (Equation 15) below using row vectors s1, s2 and s3 of three elements shown below.
where,
According to (Equation 12), since S(t0) is an orthogonal matrix, [U(t0)V(t0)W(t0)] can be expressed by (Equation 16). Here, symbol “T” affixed at the top left of each matrix means that the matrix is transformed into a transposed matrix.
According to (Equation 13), since S(t1) is an orthogonal matrix, [U(t1)V(t1)W(t1)] can be expressed by (Equation 17).
On the other hand, assuming the respective azimuth components corresponding to (ijk) of U(t0), V(t0), W(t0), U(t1), V(t1) and W(t1) are column vectors u(t0), v(t0), w(t0), u(t1), v(t1) and w(t1) of three elements, the following (Equation 18) and (Equation 19) hold.
[U(t0)V(t0)W(t0)]=[i(t0)j(t0)k(t0)][u(t0)v(t0)w(t0)] (Equation 18)
[U(t1)V(t1)W(t1)]=[i(t1)j(t1)k(t1)][u(t1)v(t1)w(t1)] (Equation 19)
Since [i, j, k] are orthonormal bases, the following (Equation 20) is obtained from (Equation 16) and (Equation 18).
u(t0)=Ts1(t0), v(t0)=Ts2(t0), w(t0)=Ts3(t0) (Equation 20)
Likewise, the following (Equation 21) is obtained from (Equation 17) and (Equation 19).
u(t1)=Ts1(t1), v(t1)=Ts2(t1), w(t1)=Ts3(t1) (Equation 21)
The distal end direction Q is invariable before and after the rotation, that is, independent of time. Therefore, the following (Equation 22), (Equation 23) and (Equation 24) hold.
U(t0)·Q=U(t1)·Q (Equation 22)
V(t0)·Q=V(t1)·Q (Equation 23)
W(t0)·Q=W(t1)·Q (Equation 24)
Here, assuming the matrix whose elements are the respective direction components corresponding to [ijk] of Q is q, the following (Equation 25), (Equation 26) and (Equation 27) hold.
0=U(t0)·Q−U(t1)·Q=(U(t0)−U(t1))·Q=T(u(t0)−u(t1))q=T(Ts1(t0)−Ts1(t1))q=(s1(t0)−s1(t1))q (Equation 25)
0=V(t0)·Q−V(t1)·Q=(V(t0)−V(t1))·Q=T(v(t0)−v(t1))q=T(Ts2(t0)−Ts2(t1))q=(s2(t0)−s2(t1))q (Equation 26)
0=W(t0)·Q−W(t1)·Q=(W(t0)−W(t1))·Q=T(w(t0)−w(t1))q=T(Ts3(t0)−Ts3(t1))q=(s3(t0)−s3(t1))q (Equation 27)
where,
(S(t0)−S(t1))q=0 (Equation 29)
Q is the axis of rotation and since the position H of the sensor 40 moves within a plane perpendicular to the axis of rotation during rotation, the following (Equation 30) holds.
Q·(H(t0)−H(t1))=0 (Equation 30)
That is, assuming matrices whose elements are the respective direction components corresponding to {ijk} of H(t0) and H(t1) are h(t0) and h(t1), the following (Equation 31) holds. The respective components of H(t0) and H(t1) are outputted from the sensor unit 32.
T(h(t1)−h(t0))q=0 (Equation 31)
Furthermore, since the Q is a basic vector, the following (Equation 32) holds.
|q|=1 (Equation 32)
Therefore, the q is calculated from (Equation 29), (Equation 31) and (Equation 32).
When the calculated Q is expressed as a function of U(t1), V(t1) and W(t1), the Q is expressed by the following (Equation 33) and relative position coefficients a6, b6 and c6 are calculated.
Q=a
6
U(t1)+b6V(t1)+c6W(t1) (Equation 33)
Next, the operation of the direction correction section 31C will be described. The operation of the direction correction section 31C is basically the same as the operation of the first embodiment, that is, corrects the direction of the first sensor 40 and successively calculates the longitudinal direction of the distal end portion 22. To be more specific, the direction correction section 31C operates as follows.
Assuming the direction of the first sensor 40 at an arbitrary time t is U(t), V(t) and W(t), the navigation unit 31 can calculate the distal end direction Q(t) of the probe from the following (Equation 34).
Q(t)=a6U(t)+b6V(t)+c6W(t) (Equation 34)
The Q(t) calculated here is transmitted to the navigation section 31E.
Furthermore, the operation of the reference azimuth calculation section 31D will be described.
The operator bends the bending portion 12A in an upward direction of the ultrasound image using the bending knob 12C as shown in
When the calculated P is expressed as a function of U(t3), V(t3) and W(t3), the P is expressed as (Equation 35) below, and the reference azimuth calculation section 31D can calculate relative position functions a7, b7 and c7 according to (Equation 35).
P=a
7
U(t3)+b7V(t3)+c7W(t3) (Equation 35)
Furthermore, the reference azimuth calculation section 31D which is reference azimuth calculation means calculates the reference azimuth V12(t3) according to the following (Equation 36).
V
12(t3)=P×Q(t3)=(b7c6−c7b6)U(t3)+(c7a6−a7c6)V(t3)+(b7c6−c7b6)W(t3) (Equation 36)
Next, the operation of the reference azimuth correction section 31F which is the reference azimuth correction means will be described. The reference azimuth correction section 31F corrects the direction of the first sensor 40 and successively calculates the reference azimuth. To be more specific, the reference azimuth correction section 31F operates as follows.
When the direction of the first sensor 40 at an arbitrary time t is assumed to be U(t), V(t) and W(t), the navigation unit 31 calculates the reference azimuth V12(t) of the probe according to the following (Equation 37).
V
12(t)=(b7c6−c7b6)U(t)+(c7a6−a7c6)V(t)+(b7c6−c7b6)W(t) (Equation 37)
The Q(t) calculated here is transmitted to the navigation section 31E.
Finally, the operation of the navigation section will be described. The navigation section performs navigation based on the Q(t) calculated by the direction correction section and the V12(t) calculated by the reference azimuth correction section 31F.
As described above, the endoscope system 1D corrects the direction of the first sensor 40 to the distal end direction of the probe 21 through calibration by a rotation operation of the probe 21 and corrects the direction of the first sensor 40 to the reference azimuth through calibration by a bending operation. Thus, the operator can accurately grasp the vertical and horizontal directions of an ultrasound image and perform inspection or treatment with high accuracy.
When the direction of the first sensor 40 and the upward direction of the ultrasound image are matched through calibration by the bending operation, if the probe is provided with a bending mechanism, the operator may perform a bending operation of the probe.
An ultrasound probe has been described above as an example of medical instrument of the medical equipment system and an upward direction of the endoscope image has been described above as a reference method, but in the case where the medical instrument is forceps, the opening/closing direction of the forceps is set as the reference azimuth. Furthermore, in the case where the medical instrument is a single-edged knife, the direction of the edge is set as the reference azimuth. Furthermore, when the medical instrument is a small endoscope inserted into the channel of the endoscope, the upward direction of an endoscope image of the small endoscope is set as the reference azimuth.
The distal end direction Q is calculated above from (Equation 29), (Equation 31) and (Equation 32), but when the value of H in (Equation 30) has substantially no difference between times t0 and t1, the error of the distal end direction Q increases. For this reason, when the distance between H(t0) and H(t1) is equal to or below a predetermined value, the medical equipment system preferably displays a message on the screen of the monitor 18 and instruct the operator to further rotate the probe 21.
The calculation in this case is as follows. Assuming the time after a second rotation is t4, the following (Equation 38) holds in the same way as (Equation 29).
(S(t0)−S(t4))q=0 (Equation 38)
The distal end direction Q of the distal end portion 22 is calculated from (Equation 29), (Equation 32) and (Equation 38). In this way, the error becomes smaller.
Furthermore, as in the cases of the first to third embodiments, the second sensor may be provided at the endoscope distal end and the position and direction information of the probe may be corrected based on information of the second sensor.
The present invention is not limited to the aforementioned embodiments, but various changes, modifications or the like can be made without departing from the spirit and scope of the present invention.
For example, the detection means for detecting the position and direction may not necessarily be a magnetic sensor. For example, a gyro sensor may be disposed at the distal end portion to detect the position and direction, a light-emitting marker such as LED may be disposed at the operation portion of a rigid endoscope, the light-receiving apparatus may detect the position and direction of the operation portion of the endoscope, convert the position to the position of the endoscope distal end portion or a fiber grating (FBG) sensor may be disposed at the insertion portion of the endoscope to detect the position and direction of the distal end portion.
Furthermore, although the flexible endoscope having the flexible portion 15 and the rigid portion 13 disposed on the distal end side of the flexible portion 15 has been described above as an example of the insertion means of the medical equipment system, the present invention is not limited to this but the insertion means may be a rigid endoscope, trocar or the like as long as the insertion means has a channel.
That is, the probe is moved in the channel of the endoscope above to correct the probe direction, but in an endoscope operation, the endoscope or treatment instrument may be moved in the trocar to correct the direction of the endoscope or treatment instrument.
As described above, the endoscope system 1D is as follows.
(1) A medical equipment system including:
insertion means including a flexible portion, a bending portion, a rigid portion and a channel that passes through the flexible portion, the bending portion and the rigid portion;
a medical instrument that is inserted from an insertion port on a proximal end portion side of the channel, projects from a projection port of the rigid portion and includes a sensor for detecting a position and direction at a distal end portion;
position calculation means for calculating the position and direction of the distal end portion from information of the sensor; and
reference azimuth calculation means for calculating, when the medical instrument rotates in the channel, a reference azimuth of the distal end portion based on the position and direction of the distal end portion before and after movement when the bending portion is bent.
(2) The medical equipment system described in (1) above, wherein the insertion means is an insertion portion of an endoscope, and
the reference azimuth is an azimuth of an image picked up by the endoscope.
(3) The medical equipment system described in (1) above, wherein the medical instrument is an ultrasound probe, and
the reference azimuth is an azimuth of an ultrasound image picked up by the ultrasound probe.
Number | Date | Country | Kind |
---|---|---|---|
2009-132390 | Jun 2009 | JP | national |
This application is a continuation application of PCT/JP2010/057456 filed on Apr. 27, 2010 and claims benefit of Japanese Application No. 2009-132390 filed in Japan on Jun. 1, 2009, the entire contents of which are incorporated herein by this reference.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2010/057456 | Apr 2010 | US |
Child | 12879362 | US |