Background technology
In recent years, the micro-wound surgical operation with laparoscopic technique as representative is rapidly growing, and many traditional operations all start to adopt
Use Minimally Invasive Surgical Technology.However, Minimally Invasive Surgery is subject to the visual field to inspect, scope is little, patient lacks tactile sensation, operative region is flexible
The restriction of the aspect such as property is little, man-machine harmony is difficult.Therefore, the level of professional operative doctor to be reached, need compared with for traditional operation
Want study and the training of longer time.Meanwhile, in traditional operative training, intern is often in veteran doctor
After demonstration, the objects such as manikin, corpse, animal are practised.However, manikin sense of reality is not, corpse resource-constrained
And expensive, animal live soma and structure are differed greatly with human body.
Then occurred as soon as the analog simulation training system with Minimally Invasive Surgery as source, emulated in most analogue system
Degree is not high, on the one hand because dummy model is not true to nature, and further aspect is that the feedback really degree of power in simulated operation.Cause
Be in minimal invasive surgical procedures, doctor be not only rely on vision come to judge apparatus and body cavity's inwall relative position and
Optimal operating position, and be to rely on feel to be used as processing a criterion of focus point when more.So
In traditional motor feedback cannot image simulation in real human body apparatus and during cavity inner wall negotiation produced beformable body become
The force of shape, makes operator lose the culture to feel, does not reach the effect of simulation training.
The study of clinical operation and training are in a medical teaching field always difficult problem, because this life being related to people is pacified
Entirely, learn in patient and training is absolutely not.Animal and obduction no doubt can play certain exercise effect,
But there is very big difference after all with real clinical operation.Therefore, three-dimensional simulation simulation training system just arises at the historic moment.But it is traditional
Motor feedback in cannot image simulation apparatus and produced beformable body deformation during cavity inner wall negotiation in real human body
Force, makes operator lose the culture to feel, does not reach the effect of simulation training.The present invention utilizes specially designed hardware to tie
Structure, emulation operating theater instruments, sensor and force feedback structure is combined, reaches the mould of the various clinical operation of analogue simulation
Fit the system of training effect.
The applicant once disclosed the patent of invention of a Patent No. ZL201320068523.0, name in 2013.11.27
For " a kind of force feedback endoscopic surgery training devicess ", its scheme employs a kind of magnetive attraction feed back control system, by driving
Circuit makes force feedback coil electricity produce the certain electric field of electric current, and then produces a magnetic similar to true cavity inner wall sense of touch
, so that medical professional training person really experiences the true feel of operation process in learning process.But when actually used,
Find that this training devices has problem of dtmf distortion DTMF, need action bars just can excite force feedback after contacting cavity inner wall model, have
So that handle motion process lacks sense of reality, handle motion process is unable to complete monitoring, handle image meeting to certain hysteresis quality simultaneously
The phenomenons such as generation is beated, play, have had a strong impact on training effect.
Content of the invention
In place of overcoming the deficiencies in the prior art, the present invention provides a kind of endoscope's simulation training with soft force feedback
System, to solve the technical problem of prior art presence.
The technical solution adopted in the present invention is:A kind of endoscope's simulation training system with soft force feedback, this is
System includes:
One three-dimensional rotating operation platform, described three-dimensional rotating operation platform horizontally rotates support by a vertical rotation support and one
Composition, wherein, described horizontally rotate support include base, turntable and two clamping plates composition, be provided with vertical shaft in the middle of described base,
Described turntable is provided with a centre bore, and in the hole is provided with bearing, and described turntable suit is described vertical shaft, and described vertical shaft upper end is worn
Cross described turntable centre bore and couple with the horizontal direction Circular gratings rotary encoder being fixed on described turntable upper surface;Described
Vertical rotation support includes an operating theater instruments fixed plate and U-bracket, and described operating theater instruments fixed plate both sides are respectively provided with a horizontal stroke
Axle, inserts in the through hole in described U-bracket vertical plates on both sides respectively, and two pieces of described clamping plate and institute are passed through in described U-bracket bottom
State turntable to be fixed as one, be bolted between two pieces of described clamping plate;A piece transverse axis of described operating theater instruments fixed plate
Outer end is affixed with the above-below direction Circular gratings rotary encoder of the side being arranged at described U-bracket, and described operating theater instruments are fixed
Another transverse axis outer end of plate is affixed with the above-below direction electromagnetic brake being fixed on described U-bracket opposite side;
One is fixed on the CTVE operating theater instruments on this three-dimensional rotating operation platform, including operation handle and being attached thereto
Stick, equipped with a linear bearing, described linear bearing is fixed on described operating theater instruments fixed plate to described stick outer cover
Upper end;The periphery of described stick is provided with tooth bar, has a breach in the middle of described linear bearing bottom, and breach is built with one
Spur gear, this spur gear is engaged with the periphery tooth bar of described stick;Described spur gear is coaxially equipped with upper conical gear and front
Rear direction Circular gratings rotary encoder, the two is located at the both sides of described linear bearing respectively;Conical gear and lower circular cone tooth on this
Wheel engagement;Described lower conical gear is fixed on a magnetic shaft end, and described operating theater instruments are fixed in this magnetic axle lower end and one
Permanent magnetism ferropexy cylindrical moveable connection in fixed plate, described permanent magnetism ferropexy bottom of cylinder passes through screw and fore-and-aft direction electromagnetism
Brake is fixedly connected;Three blind holes substantially arranging in line, described magnetic is had in described permanent magnetism ferropexy cylinder bore
Property axle bottom is installed in central blind hole, can be freely rotatable in this central blind hole;All solid in the blind hole of described central blind hole both sides
Surely there is permanent magnet, 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 is solid
Determine cylinder to be adsorbed on described magnetic axle, described permanent magnetism ferropexy cylinder two ends are positioned by bearing block, can be with described magnetic axle
Rotate together;
Described magnetic axle is relied on together with magnetic-adsorption with described permanent magnetism ferropexy cylinder, is being unsatisfactory for producing force feedback
During condition, the rotor of permanent magnetism ferropexy cylinder and fore-and-aft direction electromagnetic brake is with magnetic axle synchronous axial system, fore-and-aft direction electromagnetism
The stator of brake is fixed in the mounting seat in operating theater instruments fixed plate;Once running into condition (the i.e. needs meeting force feedback
There is force feedback) when, the signal of telecommunication can be passed to fore-and-aft direction electromagnetic brake by Single Chip Microcomputer (SCM) system, and electromagnetic brake typically adopts
Electromagnetic powder brake, forms magnetic field during magnetizing coil energising, magnetic powder magnetizes under the action of a magnetic field, forms magnetic powder chain, and solid
Fixed magnetic conductor is polymerized between rotor, and the adhesion by magnetic powder and frictional force realize braking.When exciting curent disappears, magnetic powder is in
Free loose condition (of surface), braking action releases.This brake small volume, lightweight, exciting power is little, and braking moment with turn
Moving part rotating speed is unrelated, is easy to automatically control it is adaptable to the drive system of various machine.Stop after fore-and-aft direction electromagnetic brake is locked
Spin-ended turn, described permanent magnetism ferropexy cylinder is also locked, and the magnetic axle of so original synchronous rotary will be with the permanent magnet of both sides
There is relative motion, handle end just may feel that the suction producing because magnetic pole separates that magnetic axle passes over, thus reaching
The effect of soft force feedback, after handle stops operation, the permanent magnet in both sides for the described magnetic axle automatically resets under attracting.
One magnetive attraction feed back control system, including Single Chip Microcomputer (SCM) system, the signal input part of described Single Chip Microcomputer (SCM) system respectively with
Described above-below direction Circular gratings rotary encoder, fore-and-aft direction disk light beam encoder and horizontal direction Circular gratings rotary encoder
Signal output part connect, for receiving the rotation parameter that sends of three described Circular gratings rotary encoders;Described single-chip microcomputer system
The signal output part of system is connected with the control end of described fore-and-aft direction electromagnetic brake, above-below direction electromagnetic brake respectively, uses
In the state switching controlling two described electromagnetic brakes.
Stick periphery is designed to rack form, freely does linear reciprocating motion under the supporting of linear bearing, behaviour
The tooth bar of vertical pole is engaged with spur gear, and this makes the linear motion of handle be converted into circular motion, is co-axially mounted with spur gear
Fore-and-aft direction Circular gratings rotary encoder just can obtain the stretching of instrument handle by reading the parameter of spur gear circular motion
Contracting kinematic parameter.Meanwhile, above-below direction Circular gratings rotary encoder can obtain the operational factor in front and back of operating theater instruments fixed plate, water
Square can obtain the horizontal rotation parameter of operating theater instruments fixed plate to Circular gratings rotary encoder, handle is in the fortune of three degree of freedom
All by above three encoder feedback to single-chip microcomputer, handle position parameter is substituted into surgical simulation scene to dynamic parameter by single-chip microcomputer,
And show that handle moves in virtual human model on a display screen, when handle position parameter error, touch virtual people
Body region, single-chip microcomputer sends control signal, controls corresponding electromagnetic brake brake, makes handle produce force feedback.Above-mentioned three
The grating disc that individual grating encoder adopts is and is circumferentially divided into 1000 units, and precision can meet emulation clamp completely
Displacement detecting need.
Beneficial effect:1. the system is simple and reasonable, and volume is relatively small, 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 allows for handss
Motion of handle can pass to analog image in real time, and process is soft true, do not have beat, the phenomenon such as play.
3. model exquisiteness true to nature.The system specially simulated effect according to real operation video frequency board design, either
The force feedback sensation of handle or visual experience, all ideally reduce the truly feels of clinical operation very much.
Specific embodiment
Referring to Fig. 1,2, as illustrated, a kind of endoscope's simulation training system with soft force feedback, this system includes:
One three-dimensional rotating operation platform, described three-dimensional rotating operation platform horizontally rotates support by a vertical rotation support and one
Composition, wherein, described horizontally rotate support and include base, cylindricality platform 21 and two clamping plates 20 form, be provided with the middle of described base
Vertical shaft, described cylindricality platform 21 is provided with a centre bore, and in the hole is provided with bearing, and described cylindricality platform 21 suit is on described vertical shaft, institute
State vertical shaft upper end pass through described cylindricality platform 21 centre bore, and be fixed on the horizontal direction Circular gratings of described cylindricality platform 21 upper surface
Rotary encoder 19 couples;
Described vertical rotation support includes an operating theater instruments fixed plate 13 and U-bracket 24, described operating theater instruments fixed plate
13 both sides are respectively provided with a transverse axis, insert in the through hole in described U-bracket 24 vertical plates on both sides respectively, described U-bracket 24 bottom
Portion is fixed as one with described cylindricality platform 21 by two pieces of described clamping plate 20, is bolted between two pieces of described clamping plate 20;
A piece transverse axis outer end of described operating theater instruments fixed plate 13 and the above-below direction Circular gratings of the side being arranged at described U-bracket 24
Rotary encoder 12 is affixed, and another transverse axis outer end of described operating theater instruments fixed plate 13 is with to be fixed on described U-bracket 24 another
The above-below direction electromagnetic brake 15 of side is affixed, and 14 is above-below direction electromagnetic brake support.U-bracket 24 front portion is provided with
Lower direction sports limiting bar 16, spacing for operating theater instruments fixed plate 13.
One be fixed on described solid rotating operation platform on CTVE operating theater instruments 2, including operation handle 25 and with
Connection stick 26, described stick 26 outer cover is fixed on described handss equipped with a linear bearing 1, described linear bearing 1
The upper end of art apparatus fixed plate 13;The periphery of described stick 26 is provided with tooth bar, has one in the middle of described linear bearing 1 bottom
Breach, breach is engaged with the periphery tooth bar of described stick 26 built with a spur gear 10, this spur gear 10;Described spur gear
10 coaxially equipped with upper conical gear 5 and fore-and-aft direction Circular gratings rotary encoder 18, and the two is located at described linear bearing 1 respectively
Both sides;On this, conical gear 5 is engaged with lower conical gear 6.
Described lower conical gear 6 is fixed on magnetic axle 22 end, and described handss are fixed in this magnetic axle 22 lower end and one
Permanent magnetism ferropexy cylinder 8 in art apparatus fixed plate 13 is actively coupled, described permanent magnetism ferropexy cylinder 8 bottom pass through screw with front
Rear direction electromagnetic brake 11 is fixedly connected.
As shown in figure 3, described permanent magnetism ferropexy cylinder is aluminum cylindrical part, centre has three and is substantially arranged in always
The blind hole of line, described magnetic axle 22 bottom is installed in central blind hole, can be freely rotatable in this central blind hole;Described center is blind
It is respectively and fixedly provided with permanent magnet 23, the magnetic pole of described permanent magnet 23 is relative with the magnetic pole opposite sex of described magnetic axle 22 in the blind hole of hole both sides
(as shown in Figure 4), by magnetic force, described permanent magnetism ferropexy cylinder 8 is adsorbed on described magnetic axle 22, described permanent magnetism ferropexy
The gear support of bearing 7 is passed through at cylinder 8 two ends and the lower gear support of bearing 9 positions, and can rotate with described magnetic axle 22.
Described magnetic axle 22 is relied on together with magnetic-adsorption with described permanent magnetism ferropexy cylinder 8, and being unsatisfactory for, generation power is anti-
During the condition of feedback, the rotor of permanent magnetism ferropexy cylinder 8 and fore-and-aft direction electromagnetic brake 11 with magnetic axle 22 synchronous axial system, in front and back
The stator of direction electromagnetic brake 11 is fixed in the mounting seat in operating theater instruments fixed plate 13;Once run into meeting force feedback
During condition (needing force feedback), the signal of telecommunication can be passed to fore-and-aft direction electromagnetic brake 11, electromagnetism by Single Chip Microcomputer (SCM) system
Brake typically adopts electromagnetic powder brake, forms magnetic field, magnetic powder magnetizes under the action of a magnetic field, formed during magnetizing coil energising
Magnetic powder chain, and be polymerized between rotor in fixing magnetic conductor, the adhesion by magnetic powder and frictional force realize braking.Exciting curent disappears
During mistake, magnetic powder is in free loose condition (of surface), and braking action releases.This brake small volume, lightweight, exciting power is little, and
Braking moment is unrelated with tumbler rotating speed, is easy to automatically control it is adaptable to the drive system of various machine.Fore-and-aft direction electromagnetism is stopped
Stop the rotation after car device 11 is locked, described permanent magnetism ferropexy cylinder 8 is also locked, and the magnetic axle 22 of so original synchronous rotary is just
With the permanent magnet 23 of both sides, relative motion can occur, what handle 25 end just may feel that magnetic axle 22 passes over separates because of magnetic pole
And the suction producing, thus reaching the effect simulating soft force feedback, after handle 25 stops operation, described magnetic axle 22 is in both sides
Permanent magnet 23 attract under automatically reset.
Magnetive attraction feed back control system, including Single Chip Microcomputer (SCM) system, the signal input part of described Single Chip Microcomputer (SCM) system respectively with institute
State above-below direction Circular gratings rotary encoder 12, fore-and-aft direction disk light beam encoder 18 and horizontal direction Circular gratings rotary coding
The signal output part of device 19 connects, for receiving the rotation parameter that three described Circular gratings rotary encoders send;Described monolithic
The signal output part of the machine system control end with described fore-and-aft direction electromagnetic brake 11, above-below direction electromagnetic brake 15 respectively
Connect, for controlling the state switching of two described electromagnetic brakes.
The system can complete the analog simulation training of multiple section office operation project.Herein with peritoneoscope Minimally Invasive Surgery
As a example Cholecystectomy.Need in laparoscopic procedures to operate two handles 25 using both hands, in addition also one simultaneously
Endoscope probes in patient body by minimally invasive wound and observes.Therefore system in terms of overall structure by two devices holds and centre
Endoscope support constitute.Devices hold structure is more complicated, mainly by holder part, apparatus work support with running part,
Data read portion and force feedback part composition.Endoscope's support is more relatively easy, does not have force feedback, and its effect is mainly
Adjust the visual field and angle:Simulated endoscope such as advances, retreats and rotates at the action.Reciprocal fortune under the supporting of the online bearing of handle 25
Dynamic is the real apparatus fore-and-aft direction motion of simulation, and handle 2525 motion passes through sensor feedback to single-chip microcomputer, in display screen
Above just it is observed that handle 25 moves in digital model.In order that emulation is more true, the system also simulates and performed the operation
The resistance sense of tissue is encountered, i.e. force feedback in journey.In the present system, the mode of force feedback uses magnetic force feedback.This
The advantage of magnetic force feedback is soft, stable, and reliable, high precision.In the system, meet in following several condition
One, all can trigger force feedback effect:1. in operating process, handle 25 encounters the tissue that should not encounter and organ;2. according to software
Illustrate to touch the key point needing touching;3. when cutting unwanted tissue using simulation electric knife.
The electromagnetic brake locked time can also be arranged by software, can select locked always locked with moment right
The different mode such as unblock afterwards.(motion of above-below direction and left and right directions, transmission, sensor and force feedback with above-mentioned explanation in the same manner,
Here does not repeat one by one)
The Circular gratings adopting in the present invention are circumferentially divided into 1000 units, and precision can meet emulation clamp completely
Displacement detecting.Followed by hardware and parametrization threedimensional model, effect is really true to life.The model built up is placed on a space
In coordinate system, it is divided into several units in X, Y, Z-direction, these units are in software with emulating the space bit of operating theater instruments
The parameterized model that shifting scope respectively obtains is corresponding with emulation apparatus model unit.
As shown in figure 5, clamp sensor 3 is three foot rotational potentiometers, wherein common end grounding, the both sides of handle 25 are respectively
It is connected on the two ends of potentiometer variable resistance.This potentiometer can detect and the kinematic parameter of handle 25 is passed to single-chip microcomputer.In figure
Stick turn-sensitive device 2 be also principle using potentiometer.When stick 26 moves forward and backward, will be produced by code sensor 18
Raw y-component, produces z-component by code sensor 12 when rotating upwardly and downwardly, produces x-component by code sensor 12 when horizontally rotating.
The α component being produced by clamp sensor 3 when simultaneously coordinating upper handle 25 closure again and stick 26 drive stick rotation when rotating
Turn the β component of sensor 2 generation, go by cable synchronous transfer to Single Chip Microcomputer (SCM) system, and mathematical model is combined, thus
Constitute a string vector shift array (x, y, z, α, β), control device model carries out the 5D fortune with manipulation of physical bar 26 same trajectories
Dynamic.
The displacement of the 5D motion that above mechanical part is realized changes into digital vector signal by sensor, according to letter
Number size, to realize the modelling effect of high emulation, that is, using optimizing accurate oriented bounding box (OBB) collision detection algorithm, is come real
The position calculation of existing operating theater instruments and human organ model and deformation effect, and show in real time on a display screen.
Oriented bounding box (OBB) is a cuboid, similar to AABB, but has directivity.There is the expression of multiple OBB
Mode: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, with
And central point, a spin matrix and 3 1/2 length of sides.Generally, finally a kind of expression way is the most commonly used, and with other tables
The mode of reaching is compared, and between its OBB, test for intersection is more convenient.
Below taking three plane collision detection as a example, to be realized using OBB collision detection optimized algorithm, if plane p1, to deposit
In 5 kinds of different intersecting probabilities:
1. 3 interplanars are parallel to each other to (being likely to coplanar);
2. to run through two planes parallel, thus forming two intersections being parallel to each other for plane;
3. 3 planes intersect at straight line;
4. intersect at straight line each other two-by-two between 3 planes;
5. 3 planes intersect at a point.
3 planes defined below.p1:n1X=d1,p2:n2X=d2,
p3:n3X=d3.For above-mentioned intersection " 1 ", then there is n1·(n2×n3)=0, other states can also be similar to
Method is defined.Wherein, when plane intersects at a point X=(x1,x2,x3) when, can by plane equation be considered as one 3 × 3 linear
Equation group, and solve this intersection point:
n1X=d1
n2X=d2
n3X=d3
Available Gaussian elimination method or equation group is solved according to determinant and Cramer's rule.Order According to Cramer's rule, Xie Wei:
x1=| d m1m3|/|m1m2m3|
x2=| m1d m3|/|m1m2m3|
x3=| m1m2d|/|m1m2m3|
Wherein, d=[d1d2d3]T.
The most widely suited calculation expression of selection can letter to be multiplexed some calculating formula scalar triple products as far as possible
Turn to:
x1=d u/denom
x2=m3·v/denom
x3=-m2·v/denom
Wherein, u=m2×m3, v=m1× d, denom=m1×m1×u.
In sum, by the combination of hardware, software, model and sensing device, emulation instrument handle 25 is occurring
During displacement, photoelectric encoder is converted into the signal of telecommunication by reading the data message of photoelectricity Circular gratings rotary encoder feedback, transmission
It is analyzed to Single Chip Microcomputer (SCM) system, and is transferred to background program by interface circuit synchronizing them, handle 25 is occurred space bit
The every bit moving defines to each coordinate of parameterized surgery models, this completes hardware, software and digiial mould
Data interaction, can ideally by the whole process of abdominal operation by the system demonstration complete.
Although an embodiment of the present invention has been shown and described, for the ordinary skill in the art, permissible
Understand and can carry out multiple changes, modification, replacement to these embodiments without departing from the principles and spirit of the present invention
And modification, the scope of the present invention be defined by the appended.