Disclosure of Invention
The invention aims to provide a CT three-dimensional visualization system of a puncture surgery robot, which has high image precision and high positioning precision.
The invention provides a CT three-dimensional visualization system of a puncture surgical robot, which comprises: the system comprises an ultrasonic instrument system, a space positioning system, an image acquisition system and a computer system; wherein:
the ultrasonic instrument system is used for acquiring an implemented B-mode ultrasonic image;
the space positioning system adopts electromagnetic positioning to determine the space positioning of the puncture needle;
the image acquisition system is used for acquiring the two-dimensional image into a computer so as to reconstruct a three-dimensional image;
and the computer system is used for receiving the data of the other systems and carrying out three-dimensional reconstruction and visualization on the data.
Further, the space positioning system comprises an electromagnetic transmitter, an electromagnetic receiver and an electronic unit; the electromagnetic transmitter and the electromagnetic receiver are respectively connected with the electronic unit and used for transmitting and receiving pose data.
Further, the electromagnetic receiver comprises an ultrasonic probe electromagnetic receiver and a puncture needle tail end electromagnetic receiver; the ultrasonic probe electromagnetic receiver is used for determining the spatial position of a pixel in a two-dimensional ultrasonic image in a three-dimensional lattice; the electromagnetic receiver at the tail end of the puncture needle is used for monitoring the pose of the puncture needle.
The electromagnetic transmitter is fixed relative to the surgical robot base and the surgical bed, and the electromagnetic receiver is respectively fixed on the ultrasonic probe and the tail end of the puncture needle so as to transmit and receive signals.
Furthermore, the computer system comprises a software system running on a computer, wherein the software system comprises a 2D ultrasonic image and position acquisition module thereof, a 2D ultrasonic image preprocessing and feature point extraction module, a voxel gray body calculation and three-dimensional crystal visualization module, a puncture robot motion parameter calculation module and a puncture robot motion control module. By acquiring the 2D image and the pose information of the focus and establishing the three-dimensional model of the focus by using the three-dimensional reconstruction technology, a doctor can conveniently perform surgical planning on the three-dimensional reconstruction model of the focus and designate a proper needle insertion route.
The 2D ultrasonic image and position acquisition module thereof comprises: in a freehand three-dimensional ultrasonic system based on electromagnetic positioning, software needs to acquire a 2D ultrasonic image of a focus area and pose data corresponding to each image at the same time so as to establish a three-dimensional model of the focus.
The 2D ultrasonic image preprocessing and feature point extracting module comprises: since B-mode ultrasound contains a lot of useless information areas, in order to reduce the calculation amount of three-dimensional reconstruction, the software module needs to reserve high-density important information area images and eliminate images of the useless areas. When the ultrasonic probe is calibrated, 5 bright spot areas on an image need to be extracted, and software needs to determine that the coordinates of 5 points in an image coordinate system are characteristic points.
The voxel gray body calculation and three-dimensional crystal visualization module comprises: the software module firstly calculates the coordinates of pixel points in a two-dimensional image in a three-dimensional lattice according to the calibration result of the probe and the coordinate transformation relation between the electromagnetic emitter and the three-dimensional image, then calculates the voxel gray scale according to the spatial position relation between voxels and pixels in the three-dimensional lattice, finally displays the three-dimensional lattice after the voxels are filled through a three-dimensional visualization technology, and allows a doctor to carry out interactive operations such as sectioning and measurement on the three-dimensional lattice so as to select an optimal needle insertion path.
The puncture robot motion parameter calculation module: the software module firstly maps the needle insertion path in the three-dimensional image to a robot space through coordinate transformation, and then calculates the motion parameters of the robot according to the geometric relationship between the robot and the needle insertion path and the puncture needle: three translation amounts of the arm, two rotation angles of the wrist, and the depth of the needle insertion.
The puncture robot motion control module: based on the motion planning of the robot, the software module realizes the motion function required by the robot puncture operation. The motion of the robot can be divided into arm translation motion, wrist rotation motion, needle insertion motion and needle withdrawal motion according to the sequence. The arm translation motion is realized by a robot external force dragging mode, and is similar to clinical manual puncture. In order to keep the needle point still when the wrist adjusts the puncture needle position, the software realizes the robot fixed-point posture adjustment function through a needle point displacement compensation algorithm ' refer to ' puncture surgery robot auxiliary system research based on three-dimensional ultrasonic images '. The problems of safety, soft tissue deformation and the like need to be considered when the robot is used for needle insertion, and the software realizes the fuzzy control of the needle insertion speed of the robot based on force/position feedback. After tissue extraction or treatment is completed, the robot rapidly withdraws the puncture needle to a safe position along the needle insertion path.
In the motion parameter calculation module of the puncture robot, the required position of the robot can be represented in the laplace domain as follows: firstly, the impedance control position model building module used by the method is as follows:
Fh=Md(Xd-Xc)+Bd(Xd-Xc)+Kd(Xd-Xc);
wherein: xcIndicates the current position, XdIndicating the desired position, MdVirtual inertia matrix representing the robot, BdVirtual damping matrix, K, representing a robotdVirtual stiffness matrix representing a robot, M in a modeld,KdImpedance of robotThe characteristic coefficients are all diagonal arrays. MdThe virtual inertia matrix has strong impact force and great influence on the motion process with large speed transformation; b isdThe virtual damping matrix has great influence on external interference and rapid movement of position change; the virtual stiffness matrix has a large influence on motion near a low-speed motion or stationary state.
The robot desired position can then be expressed in the laplace domain as:
△X(S)=Fh(s)/Mds2+BdS+Kd=Fh(s)H(s); (1)
wherein, Delta X(S)Is the Laplace transform of DeltaX, Fh(s) is FhAnd laplace transform of s. S, obtaining the position of the robot through a six-dimensional force sensor; h(s) obtaining the position of the outer robot on the height through a six-dimensional force sensor;
through the analysis, the controller for the compliant position of the robot joint space is as follows:
wherein, f is the external acting force obtained by the six-dimensional force sensor.
An expression of velocity and acceleration is obtained by using a backward difference method:
△X(k)=a0△F(k)+a1△x(k-1)+a2△x(k-2); (3)
wherein:
wherein: fh is Md(Xd-Xc)+Bd(Xd-Xc)+Kd(Xd-Xc);
Xc represents the current position, Xd represents the desired position, Md represents the virtual inertial matrix of the robot, Bd represents the virtual damping matrix of the robot, Kd represents the virtual stiffness matrix of the robot, and T is the sampling time.
Furthermore, in the three-dimensional crystal visualization module, a Ray-Casting algorithm is adopted. The Ray-Casting algorithm, belonging to the volume rendering algorithm, is a light Ray transmission method, and has higher and clearer image quality. The basic principle of Ray Casting (Ray-Casting) is that, based on the visual imaging mechanism, an idealized physical model is first constructed (i.e. each voxel is considered as a particle capable of projecting, emitting and reflecting light), then a specific color value v I (the gray level image is a gray level value, also called light intensity) and opacity (opacity) are assigned to each voxel according to the illumination model, the shading model and the medium properties of the voxel, then a ray is emitted from each pixel point on the screen along the set sight line direction, the ray passes through the three-dimensional data field and intersects with a plurality of voxels, selecting a plurality of equidistant or non-equidistant sampling points on a ray, and solving the color value and opacity of all the sampling points on the ray by an interpolation method (nearest neighbor interpolation or trilinear interpolation), see 'research on puncture surgery robot auxiliary system based on three-dimensional ultrasonic images'.
The invention has the beneficial effects that:
through the effect of electromagnetic positioning, the location ability is strong, and the interference killing feature is strong to the volume is miniature, can obtain better precision effect under the operation, plays a better precision assurance effect to the three-dimensional visualization of later stage, guarantees that the three-dimensional effect of later stage is more accurate, can obtain accurate route planning in the puncture operation.
Detailed Description
The present invention will be further described in detail with reference to the following specific examples:
the invention aims to provide a CT three-dimensional visualization software system of a puncture surgery robot, which has high image precision and high positioning precision.
As shown in fig. 1, in order to ensure high image precision and high positioning precision during use, the invention relates to a CT three-dimensional visualization software system for a puncture surgical robot, comprising:
the system comprises an ultrasonic instrument system, a space positioning system, an image acquisition system and a computer system;
the ultrasonic instrument system is used for acquiring an implemented B-mode ultrasonic image; the space positioning system adopts an electromagnetic positioning system and is used for determining the space positioning of the puncture needle; the image acquisition system is used for acquiring a two-dimensional image into a computer so as to reconstruct a three-dimensional image; the computer is used for receiving data of the rest systems, and reconstructing and visualizing the data in three dimensions.
The invention has the advantages that through the electromagnetic positioning effect, the positioning capability is strong, the anti-interference capability is strong, the size is miniature, a better precision effect can be obtained under the operation, a better precision guarantee effect is realized on the later three-dimensional visualization, the later three-dimensional effect is more accurate, and the accurate path planning can be obtained in the puncture operation.
As shown in fig. 2, further, the electromagnetic positioning system includes an electromagnetic transmitter, an electromagnetic receiver, an electronic unit; the electromagnetic transmitter and the electromagnetic receiver are respectively connected with the electronic unit and used for transmitting and receiving pose data.
Further, the electromagnetic receiver comprises an ultrasonic probe electromagnetic receiver and a puncture needle tail end electromagnetic receiver; the ultrasonic probe electromagnetic receiver is used for determining the spatial position of a pixel in a two-dimensional ultrasonic image in a three-dimensional lattice; the electromagnetic receiver at the tail end of the puncture needle is used for monitoring the pose of the puncture needle. The transmitter is fixed relative to the surgical robot base and the operating bed, and the receiver is respectively fixed on the ultrasonic probe and the tail end of the puncture needle, so as to transmit and receive signals.
As shown in fig. 3, the computer system further includes a 2D ultrasound image and position acquisition module, a 2D ultrasound image preprocessing and feature point extraction module, a voxel gray body calculation and three-dimensional crystal visualization module, a puncture robot motion parameter calculation module, and a puncture robot motion control module. By acquiring the 2D image and the pose information of the focus and establishing the three-dimensional model of the focus by using the three-dimensional reconstruction technology, a doctor can conveniently perform surgical planning on the three-dimensional reconstruction model of the focus and designate a proper needle insertion route.
In actual operation, the 2D ultrasonic image and the position acquisition module thereof are used for acquiring the 2D ultrasonic image of a focus area and the pose data corresponding to each image so as to establish a three-dimensional image of the focus, and the 2D ultrasonic image preprocessing and feature point extraction module is used for removing useless information areas in B-mode ultrasonography so as to reduce the calculation amount of three-dimensional reconstruction. The coordinate of a pixel point of the two-dimensional image in the three-dimensional lattice is calculated by a voxel gray body calculation and three-dimensional crystal visualization module according to the calibration result of the probe and the coordinate transformation relation between the electromagnetic emitter and the three-dimensional image, then the voxel gray is calculated according to the spatial position relation between the voxel and the pixel in the three-dimensional lattice, finally the three-dimensional lattice filled with the voxel is displayed by a three-dimensional visualization technology, and a doctor is allowed to carry out sectioning, measurement and other interactive operations on the three-dimensional lattice so as to select the optimal needle insertion path.
Further, the three-dimensional crystal visualization module adopts a Ray-Casting algorithm. The Ray-Casting algorithm, belonging to the volume rendering algorithm, is a light Ray transmission method, and has higher and clearer image quality.
In actual operation, firstly constructing an ideal physical model by a ray transmission method according to a visual imaging mechanism, then distributing a specific color value and different transparencies for each voxel according to a lighting model, a shading model machine and the medium attributes of the voxels, then starting from each pixel point on a screen, sending a ray along a set ray direction, enabling the ray to pass through a three-dimensional data field and intersect with a plurality of voxels, selecting a plurality of equidistant or non-equidistant sampling points on the ray, calculating the color value and the opacity of all the sampling points on the ray by a difference method, setting the intersection point of the ray and the voxels as the sampling points, finally respectively synthesizing and accumulating the color value and the opacity of all the sampling points on the ray in a right backward or forward or backward sequence, and stopping ray propagation when the opacity is accumulated to 1 or the ray passes through the three-dimensional data field, and the current synthesized color value is taken as the color value of the pixel point on the screen.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and features disclosed herein.