Background technology
In recent years, be that the micro-wound surgical operation of representative rises rapidly with laparoscopic technique, many traditional operations all start to adopt Minimally Invasive Surgical Technology.But Minimally Invasive Surgery is subject to the visual field and inspects the restriction that scope is little, patient lacks the aspects such as tactile sensation, operative region dirigibility is little, man-machine harmony is difficult.Therefore, the level of professional operative doctor be reached, need study and the training of longer time compared with traditional operation.Meanwhile, in traditional operative training, intern practises objects such as artificial model, corpse, animals often after veteran doctor's demonstration.But the artificial model sense of reality is inadequate, corpse resource-constrained and expensive, animal live soma and structure and human body differ greatly.
Then just occurred the analog simulation training system taking Minimally Invasive Surgery as source, in most analogue system, fidelity is not high, on the one hand because dummy model is true to nature not, and is the feedback really degree of power in simulated operation on the other hand.Because in minimal invasive surgical procedures, doctor relies on vision to judge the relative position of apparatus and body cavity's inwall and optimal operating position, and time more is the criterion relying on feel to be used as processing focus point.So cannot the force of beformable body distortion that produces when apparatus and cavity inner wall negotiation in real human body of the simulation of image in traditional motor feedback, make operator lose cultivation to feel, do not reach the effect of simulation training.
Study and the training of clinical operation are a difficult problem in medical teaching field always, because this is related to the life security of people, are absolutely not in patient study and training.Animal and autopsy no doubt can play certain exercise effect, but have very large difference with real clinical operation after all.Therefore, three-dimensional simulation simulation training system has just arisen at the historic moment.But cannot the force of beformable body distortion that produces when apparatus and cavity inner wall negotiation in real human body of the simulation of image in traditional motor feedback, make operator lose cultivation to feel, do not reach the effect of simulation training.The present invention utilizes custom-designed hardware configuration, emulation operating theater instruments, sensor and force feedback structure is combined, and reaches the simulation of the various clinical operation of analogue simulation and the system of training effect.
The applicant once disclosed in 2013.11.27 the patent of invention that a patent No. is ZL201320068523.0, " a kind of force feedback endoscopy trainer " by name, its scheme have employed a kind of magnetive attraction feed back control system, to be exerted all one's strength the certain electric field of tickler energising generation current by driving circuit, and then produce a magnetic field similar to true cavity inner wall sense of touch, thus make medical professional training person in learning process, really experience the true feel of surgical procedure.But when reality uses, find that this trainer exists problem of dtmf distortion DTMF, could feed back by excitation force after needing control lever to pass through contact cavity inner wall model, there is certain hysteresis quality, handle motion process is made to lack the sense of reality, simultaneously handle motion process can not complete monitoring, handle image can produce beat, the phenomenon such as play, had a strong impact on training effect.
Summary of the invention
For overcoming the deficiencies in the prior art part, the invention provides a kind of endoscope simulation training system with gentle force feedback, to solve the technical matters that prior art exists.
The technical solution adopted in the present invention is: a kind of endoscope simulation training system with gentle force feedback, and this system comprises:
One three-dimensional rotating operation platform, described three-dimensional rotating operation platform horizontally rotates support by a vertical rotation support and one and forms, wherein, described horizontally rotate support comprise base, turntable and two clamping plates composition, be provided with vertical shaft in the middle of described base, described turntable is provided with a center pit, is provided with bearing in hole, described turntable suit is described vertical shaft, and described vertical shaft upper end connects with the horizontal direction Circular gratings rotary encoder being fixed on described turntable upper surface through described turntable center pit; Described vertical rotation support comprises an operating theater instruments fixed head and U-shaped support, described operating theater instruments fixed head both sides are respectively provided with a transverse axis, insert in the through hole in described U-shaped support vertical plates on both sides respectively, described U-shaped frame bottom is fixed as one by two pieces of described clamping plate and described turntable, is bolted between two pieces of described clamping plate; A transverse axis outer end of described operating theater instruments fixed head is affixed with the above-below direction grating encoder of the side being arranged at described U-shaped support, and another root transverse axis outer end of described operating theater instruments fixed head is affixed with the above-below direction electromagnetic brake being fixed on described U-shaped support opposite side;
One is fixed on the Virtual Endoscopy operating theater instruments on this three-dimensional rotating operation platform, the operating rod comprising operating grip He be attached thereto, and described operating rod outer cover is equipped with a linear bearing, and described linear bearing is fixed on the upper end of described operating theater instruments fixed head; The periphery of described operating rod is provided with tooth bar, and have a breach in the middle of bottom described linear bearing, breach is built with a spur gear, and this spur gear engages with the periphery tooth bar of described operating rod; Described spur gear is coaxially equipped with conical gear and fore-and-aft direction Circular gratings rotary encoder, and the two lays respectively at the both sides of described linear bearing; On this, conical gear engages with lower conical gear; Described lower conical gear is fixed on a magnetic shaft end, the permanent magnet stationary cylinder that this magnetic axle lower end and one is fixed on described operating theater instruments fixed head is actively coupled, and is fixedly connected bottom described permanent magnet stationary cylinder by screw and fore-and-aft direction electromagnetic brake; Have three blind holes substantially arranged in line in described permanent magnet stationary cylinder inner chamber, described magnetic axle bottom is installed in central blind hole, freely can rotate in this central blind hole; All permanent magnet is fixed with in the blind hole of described central blind hole both sides, the magnetic pole of described permanent magnet is relative with the magnetic pole opposite sex of described magnetic axle, by magnetic force, described permanent magnet stationary cylinder is adsorbed on described magnetic axle, described permanent magnet stationary cylinder two ends are located by bearing seat, can rotate with described magnetic axle;
Described magnetic axle and described permanent magnet stationary cylinder rely on together with magnetic-adsorption, when not meeting the condition producing force feedback, the rotor of permanent magnet stationary cylinder and fore-and-aft direction electromagnetic brake is with magnetic axle synchronous axial system, and the stator of fore-and-aft direction electromagnetic brake is fixed on the mount pad on operating theater instruments fixed head; Once run into the condition (i.e. needs forces occurring feedback) meeting force feedback, Single Chip Microcomputer (SCM) system can by electrical signal transfer to fore-and-aft direction electromagnetic brake, electromagnetic brake generally adopts electromagnetic powder brake, magnetic field is formed during magnetizing coil energising, magnetic magnetizes under magnetic fields, form magnetic chain, and be polymerized with between rotor at fixing magnetic conductor, by adhesion and the friction force realization braking of magnetic.When exciting curent disappears, magnetic is in free loose condition (of surface), and braking action is removed.This brake volume is little, lightweight, and exciting power is little, and braking moment and tumbler rotating speed have nothing to do, and are convenient to automatic control, are applicable to the drive system of various machine.Stop the rotation after fore-and-aft direction electromagnetic brake is locked, described permanent magnet stationary cylinder is also locked, the magnetic axle of so original synchronous rotary will with the permanent magnet generation relative motion of both sides, handle end will feel the suction produced because magnetic pole is separated that magnetic axle passes over, thus reach the effect of gentle force feedback, after handle shut-down operation, automatically reset under the permanent magnet of described magnetic axle in both sides attracts.
One magnetive attraction feed back control system, comprise Single Chip Microcomputer (SCM) system, the signal input part of described Single Chip Microcomputer (SCM) system is connected with the signal output part of described above-below direction grating encoder, fore-and-aft direction grating coding disk and horizontal direction grating encoder respectively, for receiving the rotation parameter that three described grating coding disks send; The signal output part of described Single Chip Microcomputer (SCM) system is connected with the control end of described fore-and-aft direction electromagnetic brake, above-below direction electromagnetic brake respectively, switches for the state controlling two described electromagnetic brakes.
Operating rod periphery is designed to rack form, linear reciprocating motion is done freely under the supporting of linear bearing, the tooth bar of operating rod engages with spur gear, this makes the rectilinear motion of handle be converted into circular motion, just by reading the parameter of spur gear circular motion, the stretching motion parameter of instrument handle can be obtained with spur gear coaxial mounted fore-and-aft direction Circular gratings rotary encoder.Simultaneously, above-below direction grating encoder can obtain the front and back operational factor of operating theater instruments fixed head, what horizontal direction grating encoder can obtain operating theater instruments fixed head horizontally rotates parameter, handle three degree of freedom kinematic parameter all by above-mentioned three encoder feedback to single-chip microcomputer, handle position parameter is substituted into surgical simulation scene by single-chip microcomputer, and demonstrate handle on a display screen and move in virtual human model, when handle position parameter error, touch virtual human body, namely single-chip microcomputer sends control signal, control the brake of corresponding electromagnetic brake, handle is made to produce force feedback.The grating disc that above-mentioned three grating coding disks adopt is and is circumferentially being divided into 1000 units, and precision can meet the displacement detecting needs of emulation clamp completely.
Beneficial effect: 1. native system is simple and reasonable, and volume is relatively little, easy to carry and transport.
2. sensor accuracy is high, and simulation process is true.Because sensor grating disc dividing unit is very little, this just makes handle motion can pass to analog image in real time, and process is truly soft, do not have beat, the phenomenon such as play.
3. model exquisiteness true to nature.No matter native system, specially according to the simulated effect of real operation video frequency board design, is the force feedback sensation of handle or visual experience, all very ideally reduces the truly feels of clinical operation.
Embodiment
See Fig. 1,2, as shown in the figure, a kind of endoscope simulation training system with gentle force feedback, this system comprises:
One three-dimensional rotating operation platform, described three-dimensional rotating operation platform horizontally rotates support by a vertical rotation support and one and forms, wherein, describedly horizontally rotate support and comprise base, cylindricality platform 21 and two clamping plates 20 and form, vertical shaft is provided with in the middle of described base, described cylindricality platform 21 is provided with a center pit, bearing is provided with in hole, described cylindricality platform 21 suit is on described vertical shaft, described vertical shaft upper end through described cylindricality platform 21 center pit, and connects with the horizontal direction Circular gratings rotary encoder 19 being fixed on described cylindricality platform 21 upper surface;
Described vertical rotation support comprises an operating theater instruments fixed head 13 and U-shaped support 24, described operating theater instruments fixed head 13 both sides are respectively provided with a transverse axis, insert in the through hole in described U-shaped support 24 vertical plates on both sides respectively, be fixed as one with described cylindricality platform 21 by two pieces of described clamping plate 20 bottom described U-shaped support 24, be bolted between two pieces of described clamping plate 20; A transverse axis outer end of described operating theater instruments fixed head 13 is affixed with the above-below direction grating encoder 12 of the side being arranged at described U-shaped support 24, another root transverse axis outer end of described operating theater instruments fixed head 13 is affixed with the above-below direction electromagnetic brake 15 being fixed on described U-shaped support 24 opposite side, and 14 is above-below direction electromagnetic brake supports.U-shaped support 24 front portion is provided with above-below direction sports limiting bar 16, spacing for operating theater instruments fixed head 13.
One is fixed on the Virtual Endoscopy operating theater instruments 2 on described three-dimensional rotating operation platform, the operating rod 26 comprising operating grip 25 and be attached thereto, described operating rod 26 outer cover is equipped with a linear bearing 1, and described linear bearing 1 is fixed on the upper end of described operating theater instruments fixed head 13; The periphery of described operating rod 26 is provided with tooth bar, and have a breach in the middle of bottom described linear bearing 1, breach is built with a spur gear 10, and this spur gear 10 engages with the periphery tooth bar of described operating rod 26; Described spur gear 10 is coaxially equipped with conical gear 5 and fore-and-aft direction Circular gratings rotary encoder 18, and the two lays respectively at the both sides of described linear bearing 1; On this, conical gear 5 engages with lower conical gear 6.
Described lower conical gear 6 is fixed on magnetic axle 22 end, the permanent magnet stationary cylinder 8 that this magnetic axle 22 lower end and one is fixed on described operating theater instruments fixed head 13 is actively coupled, and is fixedly connected bottom described permanent magnet stationary cylinder 8 by screw and fore-and-aft direction electromagnetic brake 11.
As shown in Figure 3, described permanent magnet stationary cylinder is aluminum cylindrical part, and centre has three blind holes substantially arranged in line, and described magnetic axle 22 bottom is installed in central blind hole, freely can rotate in this central blind hole; Permanent magnet 23 is all fixed with in the blind hole of described central blind hole both sides, the magnetic pole of described permanent magnet 23 and the magnetic pole opposite sex relative (as shown in Figure 4) of described magnetic axle 22, by magnetic force, described permanent magnet stationary cylinder 8 is adsorbed on described magnetic axle 22, described permanent magnet stationary cylinder 8 two ends are located by cog bearing bridge 7 and lower gear bearing bridge 9, can rotate with described magnetic axle 22.
Described magnetic axle 22 and described permanent magnet stationary cylinder 8 rely on together with magnetic-adsorption, when not meeting the condition producing force feedback, the rotor of permanent magnet stationary cylinder 8 and fore-and-aft direction electromagnetic brake 11 is with magnetic axle 22 synchronous axial system, and the stator of fore-and-aft direction electromagnetic brake 11 is fixed on the mount pad on operating theater instruments fixed head 13; Once run into the condition (i.e. needs forces occurring feedback) meeting force feedback, Single Chip Microcomputer (SCM) system can by electrical signal transfer to fore-and-aft direction electromagnetic brake 11, electromagnetic brake generally adopts electromagnetic powder brake, magnetic field is formed during magnetizing coil energising, magnetic magnetizes under magnetic fields, form magnetic chain, and be polymerized with between rotor at fixing magnetic conductor, by adhesion and the friction force realization braking of magnetic.When exciting curent disappears, magnetic is in free loose condition (of surface), and braking action is removed.This brake volume is little, lightweight, and exciting power is little, and braking moment and tumbler rotating speed have nothing to do, and are convenient to automatic control, are applicable to the drive system of various machine.Stop the rotation after fore-and-aft direction electromagnetic brake 11 is locked, described permanent magnet stationary cylinder 8 is also locked, relative motion will be there is in the magnetic axle 22 of so original synchronous rotary with the permanent magnet 23 of both sides, handle 25 end will feel the suction produced because magnetic pole is separated that magnetic axle 22 passes over, thus reach the effect of simulation gentle force feedback, after handle 25 shut-down operation, automatically reset under the permanent magnet 23 of described magnetic axle 22 in both sides attracts.
Magnetive attraction feed back control system, comprise Single Chip Microcomputer (SCM) system, the signal input part of described Single Chip Microcomputer (SCM) system is connected with the signal output part of described above-below direction grating encoder 12, fore-and-aft direction grating coding disk 18 and horizontal direction grating encoder 19 respectively, for receiving the rotation parameter that three described grating coding disks send; The signal output part of described Single Chip Microcomputer (SCM) system is connected with the control end of described fore-and-aft direction electromagnetic brake 11, above-below direction electromagnetic brake 15 respectively, switches for the state controlling two described electromagnetic brakes.
Native system can complete the analog simulation training of multiple section office operation project.Herein for the Cholecystectomy in laparoscope Minimally Invasive Surgery.Need in laparoscopic procedures to make with the hands to operate two handles 25 simultaneously, also have an endoscope to be probeed in patient body by Wicresoft's wound in addition and observe.Therefore system is propped up by two devices holds and middle endoscope and is configured in one-piece construction.Devices hold complicated structure, supports form with running part, data read portion and force feedback part primarily of holder part, apparatus work.Endoscope support is a little relatively simple, and do not have force feedback, its effect mainly regulates the visual field and angle: the actions such as simulated endoscope advance, retrogressing and rotation.Real apparatus fore-and-aft direction motion is simulated in to-and-fro movement under the supporting of the online bearing of handle 25, and handle 2525 moves through sensor feedback to single-chip microcomputer, just can observe handle 25 on a display screen and move in digital model.In order to make emulation more true, native system also simulates in surgical procedure the resistance sense encountering tissue, i.e. force feedback.In the present system, what the mode of force feedback adopted is magnetive attraction feedback.The advantage of this magnetive attraction feedback is soft, stable, and reliable, and precision is high.In native system, meet below in several condition, all can trigger force retroactive effect: 1. in operating process, handle 25 encounters the tissue and organ that should not encounter; 2. the key point needing touching is touched according to software manual; 3. when using simulation electric knife to cut unwanted organizing.
Electromagnetic brake locked time also can be arranged by software, can select locked and different mode such as moment locked then unblocks grade always.(sensor and force feedback are caught up with and are stated explanation in like manner, do not repeat one by one at this for the motion of above-below direction and left and right directions, transmission)
The Circular gratings adopted in the present invention is circumferentially being divided into 1000 units, and precision can meet the displacement detecting of emulation clamp completely.Then be hardware and parametrization three-dimensional model, effect is really true to life.The model built up is placed in space coordinates, is divided into several units in X, Y, Z-direction, and it is corresponding with emulating apparatus model unit that the parameterized model that obtains is divided equally with the space displacement scope institute of emulation operating theater instruments in software by these units.
As shown in Figure 5, clamp sensor 3 is tripod rotational potentiometer, wherein common end grounding, and the both sides of handle 25 are connected on the two ends of potentiometer variable resistance respectively.This potentiometer can detect and the kinematic parameter of handle 25 is passed to single-chip microcomputer.Operating rod rotation sensor 2 in figure is also the principle adopting potentiometer.When operating rod 26 seesaws, y component will be produced by code sensor 18, and produce z component by code sensor 12 when rotating up and down, when horizontally rotating, produce x component by code sensor 12.The β component that the α component produced by clamp sensor 3 when simultaneously coordinating upper handle 25 to close again and operating rod 26 drive operating rod rotation sensor 2 to produce when rotating, by going in cable synchronous transmission to Single Chip Microcomputer (SCM) system, combine with digital model, thus form a string vector shift array (x, y, z, α, β), control device model carries out moving with the 5D of manipulation of physical bar 26 same trajectories.
The displacement of the 5D motion realized by above mechanical part changes into digital vector signal by sensor, the modelling effect of high emulation is realized according to signal magnitude, namely adopt and optimize accurate oriented bounding box (OBB) collision detection algorithm, the position realizing operating theater instruments and human organ model is calculated and deformation effect, and shows in real time on a display screen.
Oriented bounding box (OBB) is a rectangular parallelepiped, is similar to AABB, but has directivity.There is the expression way of multiple OBB: the point set on 8 summits, the face collection in 6 faces, 3 groups of parallel surface set, a summit and 3 orthogonal edge-vectors, and central point, a rotation matrix and 3 1/2 length of sides.Usually, last a kind of expression way is the most conventional, and compared with other expression waies, between its OBB, test for intersection is more convenient.
Below for three plane collision detection, OBB collision detection optimized algorithm is adopted to realize, if plane
P
1, there are 5 kinds of different crossing possibilities:
1.3 interplanars (also may be coplanar) parallel to each other.
2. to run through two planes parallel for plane, thus form two intersections be parallel to each other.
3.3 planes are compared to straight line.
One day straight line is intersected at each other between two between 4.3 planes.
5.3 planes are compared to a bit.
Define 3 planes below.p
1:n
1·X=d
1,p
2:n
2·X=d
2,
p
3:n
3·X=d
3。For above-mentioned intersection " 1 ", then there is n
1(n
2× n
3)=0, other states also can be defined in a similar fashion.Wherein, when Plane intersects is in 1 X=(x
1, x
2, x
3) time, plane equation can be considered as 3 × 3 systems of linear equations, and solve this intersection point:
n
1·X=d
1
n
2·X=d
2
n
3·X=d
3
Gaussian elimination method can be utilized or solve this system of equations according to determinant and Cramer's rule.Order
According to Cramer's rule, Xie Wei:
x
1=|d m
1m
3|/|m
1m
2m
3
x
2=|m
1d m
3|/|m
1m
2m
3
x
3=|=
1m
2d|/|m
1m
2m
3
Wherein, d=[d
1d
2d
3]
t.
Scalar triple product can be reduced to select calculation expression---with some calculating formula multiplexing as far as possible---the most suitable:
x
1=d·u/denom
x
2=m
3·v/denom
x
3=-m
2·v/denom
Wherein, u=m
2× m
3, v=m
1× d, denom=m
1× m
1× u.
In sum, pass through hardware, software, the combination of model and sensing device, emulation instrument handle 25 is when being subjected to displacement, photoelectric encoder converts electric signal to by the data message reading photoelectricity Circular gratings rotary encoder feedback, pass to Single Chip Microcomputer (SCM) system analysis, and be transferred to background program by interface circuit and synchronize them, the every bit that handle 25 is occurred space displacement defines to each coordinate of parameterized surgery models, this completes hardware, the data interaction of software and digiial mould, ideally the whole process of abdominal operation can be demonstrated by native system.
Although illustrate and describe embodiments of the invention, for the ordinary skill in the art, be appreciated that and can carry out multiple change, amendment, replacement and modification to these embodiments without departing from the principles and spirit of the present invention, scope of the present invention is by claims and equivalents thereof.