A kind of multi-modal sensory perceptual system and data fusion method of operation on prostate robot
Technical field
The present invention relates to a kind of multi-modal sensory perceptual system of operation on prostate robot and data fusion methods, belong to medical treatment
Instrument area of computer aided field of locating technology.
Background technique
Traditional prostate intervention operation carries out puncture intervention by doctor, but due to the influence of the factors such as doctors experience, wears
Needle-holding hand art needs multiple inserting needle and constantly change inserting needle orientation, leads to that puncturing operation precision is low, the time is long, and doctor is easy tired
Labor, patient are more painful.The accuracy that prostate intervenes robot arrival target spot is higher, operating time is shorter, the labour of doctor
Intensity is lower, therefore is with a wide range of applications.
The mode that existing operation on prostate robot mostly uses single ultrasound image to navigate carries out tissue positioning and wears
Needle-holding hand art, it is this using single ultrasound image navigation by the way of carry out ultrasound image needle point identification when, often will appear super
Sound can not receive reflection signal and reflect the situation of signal inaccuracy, this has resulted in the knowledge that ultrasound image navigates to puncture needle
Certain error is not generated and random identification does not occur as to the accuracy and safety of the operation of operation on prostate robot puncturing
Property causes large effect.
Summary of the invention
In view of the disadvantages mentioned above of the prior art, experiment purpose of the invention is to provide a kind of operation on prostate robot
Multi-modal sensory perceptual system and data fusion method, it is intended to solve that existing single navigation system accuracy is not high, safety is low
The problem of.
To achieve the above object, the present invention provides a kind of multi-modal sensory perceptual system of operation on prostate robot and data
Fusion method, which is characterized in that the system includes: electromagnetic positioning system, to measure the real-time position information of puncture needle;
Ultrasound image navigation system, to measure the real time position relationship of puncture needle and tissue;Six-dimension force sensor system, to measure
Puncture needle stress condition carries out early warning and monitoring;Data fusion system, in conjunction with the electromagnetic positioning system, ultrasound image
Navigation system and six-dimension force sensor system carry out puncture needle using bayesian data fusion algorithm and Kalman filtering algorithm
Positioning in real time.
Preferably, the method includes following after prostate intervention operation robot punctures and enters tissue
Step:
(1) electromagnetic positioning system described in obtains the position coordinates of prostate intervention operation robot tip penetration needle;
(2) the ultrasound image navigation system described in obtains the position coordinates of prostate intervention operation robot tip penetration needle;
(3) the six-dimension force sensor systematic survey puncture needle described in carries out the six-dimensional force being subject to when puncturing operation;
(4) data fusion system described in is when carrying out data fusion for the first time, in conjunction with the electromagnetic positioning system, ultrasound image
Navigation system, six-dimension force sensor system, using bayesian data fusion algorithm, prostate high-precision puncture force model, to next
Convergence analysis is carried out from the data of electromagnetic positioning system, ultrasound image navigation system and six-dimension force sensor system, output punctures
Pin position coordinate, tissue ultrasound image and puncture pre-warning signal.
(5) data fusion system described in is when carrying out second and data fusion thereafter, in conjunction with the electromagnetic location
The output of system, ultrasound image navigation system, six-dimension force sensor system and last moment data fusion system, using Bayes
Data anastomosing algorithm, Kalman filtering algorithm and prostate high-precision puncture force model, it is fixed to the electromagnetism inputted from this moment
The puncture needle real time position of position system, the data of ultrasound image navigation system and six-dimension force sensor system and last moment output
Coordinate carries out fusion treatment, output puncture needle position coordinates, tissue ultrasound image and puncture pre-warning signal.
Preferably, puncture force early warning threshold values is arranged, works as six-dimension force sensor according to precedent gland high-precision puncture force model
Input power be more than current time early warning threshold values when, send alarm signal simultaneously stop puncturing operation at once.
The invention has the benefit that
(1) present invention detects the puncture process of puncture needle in such a way that multiple modalities sensor measures simultaneously, reduces
The larger disadvantage of uncertainty when single-sensor measurement, by blending algorithm identifies the higher tip position of accuracy
Coordinate.
(2) mechanical model is punctured using precedent gland high-precision in the present invention, to suffered by puncture needle end in puncture process
Power is detected, and punctured error during puncturing operation is prevented, and is caused the damage of tissue, is led to operative failure.
(3) Kalman filtering algorithm is used in the present invention, and the last moment of data fusion system output is punctured into pin position
Coordinate is merged with the position coordinates that merge at this moment, abandons the big coordinate of error, and utilize the sheet of Kalman filtering algorithm
Body characteristic predicts the path of puncture needle according to prostate biopsy mechanism, the control of puncture needle when realizing system to puncturing operation.
Detailed description of the invention:
Come to carry out detailed description to the present invention below in conjunction with attached drawing.It should be appreciated, however, that attached drawing has been provided only preferably
Understand the present invention, they should not be interpreted as limitation of the present invention.
Fig. 1 is the Technology Roadmap of the multi-modal sensory perceptual system of operation on prostate robot of the invention
Specific embodiment:
To achieve the above object, the present invention provides a kind of multi-modal sensory perceptual system of operation on prostate robot and data fusions
Method, which is characterized in that the system includes: electromagnetic positioning system, to measure the real-time position information of puncture needle;Ultrasound
Image-guidance system, to measure the real time position relationship of puncture needle and tissue;Six-dimension force sensor system is punctured to measure
Needle stress condition carries out early warning and monitoring;Data fusion system, in conjunction with the electromagnetic positioning system, ultrasound image navigation
System and six-dimension force sensor system carry out puncture needle using bayesian data fusion algorithm and Kalman filtering algorithm real-time
Positioning.
Further, after prostate intervention operation robot, which punctures, enters tissue, the method includes following
Step:
(1) electromagnetic positioning system described in obtains the position coordinates of prostate intervention operation robot tip penetration needle;
(2) the ultrasound image navigation system described in obtains the position coordinates of prostate intervention operation robot tip penetration needle;
(3) the six-dimension force sensor systematic survey puncture needle described in carries out the six-dimensional force being subject to when puncturing operation;
(4) data fusion system described in is when carrying out data fusion for the first time, in conjunction with the electromagnetic positioning system, ultrasound image
Navigation system, six-dimension force sensor system, using bayesian data fusion algorithm, prostate high-precision puncture force model, to next
Convergence analysis is carried out from the data of electromagnetic positioning system, ultrasound image navigation system and six-dimension force sensor system, output punctures
Pin position coordinate, tissue ultrasound image and puncture pre-warning signal.
(5) data fusion system described in is when carrying out second and data fusion thereafter, in conjunction with the electromagnetic location
The output of system, ultrasound image navigation system, six-dimension force sensor system and last moment data fusion system, using Bayes
Data anastomosing algorithm, Kalman filtering algorithm and prostate high-precision puncture force model, it is fixed to the electromagnetism inputted from this moment
The puncture needle real time position of position system, the data of ultrasound image navigation system and six-dimension force sensor system and last moment output
Coordinate carries out fusion treatment, output puncture needle position coordinates, tissue ultrasound image and puncture pre-warning signal.
Further, according to precedent gland high-precision puncture force model, puncture force early warning threshold values is set, six-dimension force sensor is worked as
Input power be more than current time early warning threshold values when, send alarm signal simultaneously stop puncturing operation at once.
In conclusion the present invention enters working condition when prostate operating robot carries out puncturing operation, electromagnetism is utilized
Puncture needle state when positioning system, ultrasound image navigation system and six-dimension force sensor system are by puncturing operation, tissue
Structure and needle-tissue stress condition carry out perception measurement, while utilizing the real-time coordinates of data fusion system output puncture needle
Feed back to operation on prostate robot.When carrying out puncturing operation, ultrasound image is exported to man-machine interface.The puncture of output is pre-
Alert signal, which is worked as, to be reached the progress alarm of early warning threshold values and stops procedure at once.
The above shows and describes the basic principles and main features of the present invention and the advantages of the present invention.The technology of the industry
Personnel are it should be appreciated that the present invention is not limited to the above embodiments, and the above embodiments and description only describe this
The principle of invention, without departing from the spirit and scope of the present invention, various changes and improvements may be made to the invention, these changes
Change and improvement all fall within the protetion scope of the claimed invention.The claimed scope of the invention by appended claims and its
Equivalent thereof.