CN101785704A - Self-adaptive filtering device of master-slave minimally-invasive surgery robot system - Google Patents
Self-adaptive filtering device of master-slave minimally-invasive surgery robot system Download PDFInfo
- Publication number
- CN101785704A CN101785704A CN201010019452A CN201010019452A CN101785704A CN 101785704 A CN101785704 A CN 101785704A CN 201010019452 A CN201010019452 A CN 201010019452A CN 201010019452 A CN201010019452 A CN 201010019452A CN 101785704 A CN101785704 A CN 101785704A
- Authority
- CN
- China
- Prior art keywords
- signal
- module
- trembles
- control
- master
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
The invention discloses a self-adaptive filtering device of a master-slave minimally-invasive surgery robot system, comprising a trembling action self-adaptive filtering device, a master manipulator, a position collecting module, a motion control module, a slave manipulator driving module, a detection module, a slave manipulator, a feedback module and a computer control system. The trembling action filtering device is used for filtering hand trembling actions of a surgery operator and restoring a surgery operation desired signal to the maximum degree; the master manipulator driving module in the filtering device is used for driving the master manipulator; the position collecting module is used for collecting a position signal of the master manipulator; the motion control module is used for processing the collected position signal and controlling a motor to drive the slave manipulator to complete the surgery operation; finally, the feedback module is used for supplying real-time image feedback information; therefore, a closed-loop minimally-invasive surgery robot control system is formed. The invention can effectively filter the hand trembling actions, which ensure high precision and reliability of the minimally-invasive surgery.
Description
Technical field
The present invention is a kind of adaptive filter device of master-slave minimally-invasive surgery robot system, belongs to the renovation technique of the adaptive filter device of master-slave minimally-invasive surgery robot system.
Background technology
Along with development of science and technology, medical robotic system becomes the most active in the robot research field and invests one of maximum direction, and micro-wound surgical operation (MIS) is focus application the most among the Medical Robot.Minimally-invasive surgery robot system is the typical product that Minimally Invasive Surgery in the medical science and robotics combine, its successful Application make Minimally Invasive Surgery degree of accuracy, reliability and handling aspect produced matter raising.Comparative maturity should be the endoscope's automatic station-keeping system that is used to assist Minimally Invasive Surgery (Aesop Aesop) and the ZEUS system of U.S. Computer Motion company development.Wherein Aesop Aesop adopts cascaded structure, and the ZEUS system adopts the hand operating technology of principal and subordinate, and the two can imitate the function of human arm, can accurate more and control operation stably.Leonardo da Vinci (Da Vinci) the minimally invasive surgical operation robot system that develops of American I ntuitive Surgical company has obtained European CE and U.S. food and FAD (FDA) authentication in addition.This system adopts principal and subordinate's hands structure, and the doctor controls main manipulator at control station, and by the process of coming the specific implementation operation from operator, the master-slave manipulator in this system can finish the very meticulous action that staff is difficult to finish.The whole surgery process just can be finished by very little operative incision, has reduced the risk of wound infection, has shortened the time of operation process and the rehabilitation duration of patient's postoperative, has improved surgical effect, has reduced patient's misery.Domestic is by designed neurosurgery robot of robot of BJ University of Aeronautics ﹠ Astronautics in minimally invasive surgical operation robot field main achievement.So far, existing more than 20 tame hospitals have adopted this surgical robot system, and have successfully finished the operation of 5000 many cases, have proved the reliability and the advantage that change system, have obtained good clinical and social benefit.
Although Minimally Invasive Surgery is being brought into play very big effect in improving the medical operating quality, be still waiting to improve at MIS aspect high accuracy and the real-time performance.Some need that hand is directly got involved, in the Minimally Invasive Surgery of non-remote sensing, because the influence of trembling of people's hand various degrees, there is certain deviation in the desired input information of the actual input information of operator's hand and operator in the operation process, having reduced as master-slave mode MIS is this needs that hand is directly got involved, the precision of the medical operating of non-remote sensing, has had influence on the quality of operation.This hand problem of trembling has caused a lot of scholars' concern, has also excited our interest to trembling and studying.
Trembling is a kind of class rectilinear oscillation signal at random that is superimposed upon on the desired signal, mainly shows people's extremity and head.Tremble and mainly be divided into two big classes: physiology trembles and pathology trembles.It is that we normal person is inherent but do not influence a kind of vibration of our daily life that physiology trembles.Studies show that this trembling is to be subjected to people's pressure, nervous system in daily life to also have some other factors to influence, have very little amplitude, and its energy spectrum is distributed in mainly in the scope that frequency is 8Hz-12Hz.On the contrary, it is a kind of morbid state vibration that is caused by acquired disposition that pathology trembles, and affects a lot of people's orthobiosis, even makes our normal running to realize under some occasion.Cause that the factor that pathology trembles has a lot, as: cerebellum is injured, cerebral palsy, Parkinson's disease, multiple sclerosis and ataxia etc.Pathology trembles and has bigger amplitude, and its energy spectrum mainly is distributed in the such low-frequency range of 2Hz-6Hz.
Along with the robot development of high-tech, teleoperator has also obtained application at medical field.Tremble to the influence of operation though teleoperator can reduce operator's hand to a certain extent, its real-time is still waiting to improve.In view of the needs hand is directly got involved., non-remote sensing MIS can make equipment cost lower, and can provide more real-time feedback information, allow operation technique person sensation also can bring into play these advantages of surgical experience of operator better more naturally, current in a lot of Minimally Invasive Surgerys the operation technique person relatively favor in the MIS that needs hand directly to get involved, this makes that also the research that suppresses of trembling seems to have necessity more to hand.
So far existing a lot of scholars have done relevant research and have proposed many feasible methods the inhibition of trembling, and wherein a lot of methods realize by low pass, bandpass filtering.These methods mainly contain 2 deficiencies, at first, aspect accuracy, because these filtering methods much are exactly a definite value being provided with of filtering midband width, this will cause the reservation of the losing of useful information and the information of trembling to a certain extent, so can not describe the signal that trembles exactly.Secondly, aspect real-time, because the existence meeting of wave filter causes hysteresis effect on certain degree, the signal that makes the operator import can not get handling timely, has influenced the quality of operation.Jing Zhang and Fang Chu propose can realize signal Real-time modeling set and the prediction of trembling with three rank AR models.The adaptive notch filter that Riviere and Thakor proposed is all having good effect aspect accuracy and the real-time.This method is to adopt the linear Fourier's equalizer (WFLC) based on weights that the signal that trembles is carried out modeling from these three aspects of the frequency of the signal that trembles, amplitude and phase place, and produce amplitude with the signal that trembles but compensating signal that phase place opposite identical with frequency, just realized filtering that hand is trembled with the signal (contain and tremble) of this compensating signal and the actual input of operator's hand is superimposed again.
The characteristic that Fourier analysis method is shown in some respects is not as wavelet transformation.Such as aspect the time-frequency characteristic, because the weight coefficient of Fourier analysis is the function of frequency, and the weight coefficient in the wavelet transformation is the binary function of frequency and time, and this just makes the time-frequency characteristic of wavelet transformation be better than Fourier analysis.Fourier analysis can only but can not get its corresponding time-domain information at frequency domain to the signal analysis of trembling, and this will certainly have influence on our analysis to the signal that trembles.At the localization aspect of performance, the windowing Fourier transformation is all got identical window width in time domain, and the window width of wavelet transformation then is adjustable, and it uses short window when high frequency, then use wide window when low frequency.The adaptive time frequency window that wavelet transformation had, but and the local time-domain position of focus analysis signal and local band characteristic be that Fourier analysis is incomparable, this also is why people are referred to as wavelet transformation " school microscop ".For can be accurately to tremble signal analysis and modeling we need adopt a kind of window with self adaptation resolution characteristic, and the self-adapting window in the wavelet transformation should be worth us to go to consider.In addition, Fourier analysis is suitable for the processing of gradual change signal and live signal, but the sudden change of reflected signal sensitively; And wavelet analysis is suitable for jump signal or have the processing of function of isolated singularity and the processing of self-adapting signal.Since operator's hand tremble along with the influence of several factors, such as: hand exercise track, pathological characters, psychological factor and environmental factors etc., the wherein variation of any one factor sudden change that all may cause hand to tremble is so the behavior of trembling of hand is fit to adopt wavelet transformation to handle.In view of there is the contradiction of time domain and frequency localization in Fourier analysis, lack spatial locality, and operator's hand tremble be a kind of at random, unsettled, the time signal that becomes.
Summary of the invention
The objective of the invention is to consider the problems referred to above and a kind of adaptive filter device that reaches the master-slave minimally-invasive surgery robot system of the filtration result that well trembles is provided.The present invention is convenient and practical.
Technical scheme of the present invention is: the adaptive filter device of master-slave minimally-invasive surgery robot system of the present invention, include the behavior adaptive filter device that trembles, main manipulator, the station acquisition module, motion-control module, from the operator driver module, detection module, from operator, feedback module and computer control system, the operation signal that the operator sends obtains the quasiexpectation operation signal via the behavior adaptive filter device of trembling, and by the action of quasiexpectation signal driving main manipulator, the station acquisition module that links to each other with main manipulator is gathered the main manipulator spatial positional information, send this positional information to motion-control module again, by the processing of computer control module assisted movement control module realization to the main manipulator spatial positional information, and send control signal from operator, this control signal is amplified rear drive through the operator driver module of associating and is moved from operator, detection module detects the electric current of motor from the operator driver module, speed and positional information, and feeding back to motion-control module to realize closed loop control from operator, computer control module realizes and trembles the behavior adaptive filter device, communication between motion-control module and the feedback module and monitoring.
The above-mentioned behavior adaptive filter device that trembles comprises the inertia measurement module, the filtration module that trembles, s operation control module and main manipulator driver module; The locus acceleration and the joint angle velocity information of inertia measurement module detecting operation person hand, and this is transferred to the s operation control module, by the s operation control module position acceleration signal and joint angle rate signal are converted to locus signal and joint angles signal respectively, and send this to filtration module that trembles, the filtering of trembling again by the filtration module realization of trembling, and obtain the quasiexpectation operation signal, again this quasiexpectation operation signal being input to the s operation control module handles, and obtaining a driving signal, this driving signal drives main manipulator via the main manipulator driver module.
Above-mentioned inertia measurement module comprises the three-dimensional acceleration sensing module person's hand that is used to measure the operation technique at spatial three-dimensional position acceleration promptly:
Three dimensional angular velocity pick-up module is used to measure operation technique person's hand is in spatial orientation promptly:
The above-mentioned filtration module that trembles adopts the Fuzzy Wavelet Network sef-adapting filter filtering operator hand signal that trembles to reduce its desired signal; Described Fuzzy Wavelet Network sef-adapting filter obtains compensating signal x ', y ', z ' and θ identical with tremble signal amplitude and frequency but that phase place is opposite based on Fuzzy Wavelet Network to the modeling of the signal that trembles
x', θ
y', θ
z'.Described Fuzzy Wavelet Network comprises obfuscation, fuzzy rule coupling, fuzzy reasoning and the defuzzification of input quantity to the modeling process of the signal that trembles; Fuzzy Wavelet Network comprises seven layers; Input layer, obfuscation layer, fuzzy rule layer, wavelet network layer, fuzzy reasoning layer, reconstruction of layer and output layer.
Above-mentioned s operation control module comprises AD conversion unit, D/A conversion unit, bandwidth filter, pose collecting unit, inverse kinematics computing unit and simple joint control unit; This s operation control module and computer control system two-way communication, to realize computing and control function, AD conversion unit will be digital signal by the hand analog-signal transitions of inertia measurement module collection, repeated transmission is given bandwidth filter, clocking noise signal with the generation of filtering inertia measurement module, the pose collecting unit is locus signal and angle signal with the digital signal transition after bandwidth filter is handled, and send the filtration module that trembles to and carry out Filtering Processing, the quasiexpectation signal that the inverse kinematics computing unit is exported the filtration module that trembles carries out inverse kinematics and calculates joint variable, control this joint variable by the simple joint control unit, and output changes this control signal into analogue signal by D/A conversion unit again and directly sends the main manipulator driver module to drive main manipulator the control signal of main manipulator.
Above-mentioned main manipulator driver module comprises power amplifier and Piexoelectric actuator, in order to drive main manipulator, makes it the desired track action according to the operation technique person; Comprise driver, motor and actuating device from the operator driver module, realize the DSP control module and from the driving between the operator.
Above-mentioned main manipulator directly is connected with the behavior adaptive filter device of trembling, and realizes the human computer conversation between operation technique person and the minimally-invasive surgery robot system; Above-mentioned station acquisition module realizes the collection to the positional information of main manipulator, quantizes the movement locus of main manipulator, and the positional information of gathering is directly imported into motion-control module; Above-mentioned motion-control module adopts dsp controller to realize three closed loop controls and PWM control; The outer shroud of described three closed loop controls is the Position Control ring, and innermost ring is a current regulator, and a middle ring is the speed controlling ring, described dsp controller and computer control system realization two-way communication.
Above-mentioned detection module realizes detecting and providing the closed loop feedback signal of three closed loop controls, comprises A/D converter, current sensor, photoelectric encoder, QEP circuit and frequency measurement circuit; The pulse signal of the photoelectric encoder output on the machine shaft is transferred to QEP circuit and frequency measurement circuit, pulse signal obtains position feed back signal through the QEP processing of circuit, and send Position Control ring in the motion-control module to, pulse signal is handled through frequency measurement circuit, obtain feedback speed signal, and send rate control module in the motion-control module to, current sensor senses motor winding current, and obtain its digital current signal by A/D converter, again it is sent to the current regulator in the motion-control module.
Above-mentioned is that the most key and patient get in touch a closest unit the minimally invasive surgical operation robot system from operator, operating theater instruments is housed on it, and finishes the master-slave mode micro-wound surgical operation thus; Above-mentioned feedback module is realized the supervision of minimal invasive surgical procedures and real-time information feedback by the graphics processing unit in endoscope and monitor and the computer control system, and making whole master-slave mode minimally invasive surgical operation robot system is a closed-loop control system.
Aforementioned calculation machine control system comprises communication unit, Operations Analysis and graphics processing unit; Described Operations Analysis and the two-way communication of filter module realize the computings such as digital-to-analogue conversion, analog digital conversion, inverse kinematics calculating in the filtration module, and the simple joint controller is monitored; Motion-control module is realized the transmission of data through communication unit and computer control system; Graphics processing unit is accepted the image information of endoscope's output in the feedback module, this is handled and sends to the monitor in the feedback module; Described Operations Analysis is all realized by communication unit with communicating by letter of other intermodules with graphics processing unit.
The present invention considers that the behavior of trembling of people's hand belongs to a kind of behavior of men owing to adopt hand the tremble modeling and the filtering of signal to introduce wavelet transformation, and the present invention adopts fuzzy language to express this behavior.The experience of operation technique person in operation process also is a very The key factor for operation quality and success or failure in addition, the present invention can portray this operation technique experience with fuzzy rule, it is incorporated in the minimal invasive surgical procedures, so adopted fuzzy control theory to describe this operation process qualitatively among the present invention.The present invention from wavelet transformation and these two angle design of fuzzy control a adaptive filter device based on Fuzzy Wavelet Network, overcome surgical experience based on linear Fourier's equalizer of weights and and the person that can't incorporate the operation technique indifferent based on the time frequency analysis of BP neutral net wave filter in the filtering that trembles.Adaptive filter device among the present invention is by the parameter in the automatic correction wave filter of study of neutral net.Experimental results show that this method for designing has reached the filtration result that well trembles.The present invention is that a kind of design is ingenious, function admirable, the adaptive filter device of convenient and practical master-slave minimally-invasive surgery robot system.
Description of drawings
Fig. 1 master-slave mode minimally invasive surgical operation robot overall system block diagram;
Fig. 2 behavior adaptive filter device theory diagram that trembles;
Fig. 3 behavior adaptive filter device mathematical model figure that trembles;
Fig. 4 Fuzzy Wavelet Network adaptive-filtering figure;
Fig. 5 operation technique person hand desired operation signature tune line chart;
Fig. 6 operation technique person is trembled influences the operation signal curve chart of the actual output of hand;
Fig. 7 FWNN sef-adapting filter and BP neutral net wave filter are to the error curve diagram of the signal filtering of trembling;
Fig. 8 BP neutral net wave filter is to the reduction curve chart of the disturbed operation signal of reality.
Fig. 9 FWNN sef-adapting filter is to the reduction curve chart of the disturbed operation signal of reality.
The specific embodiment
Embodiment:
The present invention relates to the tremble adaptive filter device of behavior of a kind of filtering Minimally Invasive Surgery operator hand, based on the approximation capability of Fuzzy Wavelet Network (FWNN) to any nonlinear function, to the tremble off-line modeling of behavior of operation operator hand, and can produce a kind of and the signal amplitude that trembles, frequency is identical but compensating signal that phase place is opposite, thereby reach the tremble purpose of signal of filtering.
Below in conjunction with accompanying drawing and instantiation the designed Minimally Invasive Surgery operator hand of the present invention behavior adaptive filter device that trembles is described in detail.
Fig. 1 is a master-slave mode minimally invasive surgical operation robot overall system block diagram of the present invention.The operation technique person has planned the operating procedure of operation in advance according to the medical image of patient's focus in Fig. 1.Individual adaptive filter device is arranged between operation technique person and main operation person, the auxiliary target signal filter that down operator's hand trembled of the arithmetic element of this adaptive filter device in computer control system, provide a quasiexpectation signal to drive main manipulator, make it to finish operation process according to the desired surgical operation step of operator.The station acquisition module is gathered into discrete digital signal with main manipulator at spatial movement position, and in the motion-control module the Position Control ring of sending.The Position Control ring to from the control of operator enforcing location, and is exported the quasiexpectation rate signal of a rate signal as the speed controlling ring according to input quasiexpectation position signalling and the position feed back signal that provided by detection module.The speed controlling ring to implementing speed controlling from operator, and is exported the quasiexpectation current signal of a current signal as electric current loop according to the feedback speed signal that provides by the quasiexpectation rate signal of Position Control ring input with by detection module.Current regulator is implemented Current Control according to the quasiexpectation current signal of being imported by the speed controlling ring with by the current feedback signal that detection module provides to motor again, and output voltage control signal is as the voltage control signal of PWM control module.The PWM control module is adjusted pulse width according to the voltage control signal of input and is changed the voltage that offers motor driver, thereby realizes the control to motor.Driver is according to the Control of Voltage rotating speed of motor of PWM control module output and turn to.Wherein Position Control ring, speed controlling ring, current regulator and PWM control is all realized by dsp controller, this dsp controller directly with computer control system in communication unit implementation two-way communication.Realize by motor and actuating device from the motion of operator, operating theater instruments is installed on it just can implements operation the patient.Settle endoscope just can be in operation process the present situation of performing the operation to be sent to image processing module in the computer control system with pictorial form in real time at patient's affected area, after Image Information Processing is intact again by computer control system with image information by the monitor person that feeds back to the operation technique, the operation technique person makes the surgical effect of corresponding adjustment to guarantee to reach best according to the image of feedback.
Fig. 2 is the behavior adaptive filter device theory diagram that trembles of the present invention.The described operation technique person's of Fig. 1 hand behavior realizes being connected by adaptive filter device and main manipulator, the main purpose of this device is the behavior of the trembling filtering with operation technique person hand in operative process, to greatest extent the operation technique of reduction expectation.At first be to measure the three-dimensional acceleration signal of operator's hand in the space respectively in the described behavior adaptive filter device that trembles by three-dimensional acceleration sensing module in the Inertial Measurement Unit and three dimensional angular velocity pick-up module
With the three dimensional angular rate signal
And then the digital signal that becomes computer to handle measured analog signal conversion by AD conversion unit.Signal is converted in this signal of bandwidth filter filtering that is 2.5Hz 50Hz with a frequency range after the digital quantity by the caused clocking noise signal of measurement module by analog quantity.The pose acquisition module is locus signal x from handling the pose signal of gathering operation technique person hand afterwards the information via bandwidth filter again, y, z and space anglec of rotation signal θ
x, θ
y, θ
zThe locus signal that obtains and space anglec of rotation signal carry out the modeling of off-line by the FWNN sef-adapting filter to the behavior of trembling as the input quantity of the filtration module that trembles, output tremble signal estimated value promptly: x ', y ', z ' and θ
x', θ
y', θ
z'.This estimated value negate has just been finished the tremble filtering of behavior of hand as the posture information of compensating signal that trembles and the collection of pose acquisition module is superimposed.The operation technique signal of process Filtering Processing carries out inverse kinematics by the Operations Analysis in the computer control system to it and calculates joint variable λ
1..., λ
n, and have by the simple joint controller to come its control, be the signal transition of simple joint controller output analog voltage signal V then
1..., V
nSend power amplifier to, drive main manipulator by piezoelectric actuator at last.
Fig. 3 is the mathematical model of the described behavior adaptive filter device that trembles.The expectation of operation technique person current time in the present invention operation signal d (k) as shown in Figure 3, the operation technique person current time hand signal n (k) that trembles, the operation signal s (k) of the actual output of operation technique person current time hand, wherein s (k)=d (k)+n (k).The tremble estimated value of signal of Fuzzy Wavelet Network (FWNN) output current time
The quasiexpectation operation signal y (k) of person's current time hand that after Filtering Processing, obtains the operation technique
Wherein
That statistical module is exported is quasiexpectation operation signal power E[y
2(k)].As shown in Figure 3, the pose signal s (k) that measures from Inertial Measurement Unit obtains its past pose signal constantly promptly after delay component is handled: s (k-1), s (k-2), these delay signals of s (k-n) are as the input quantity of Fuzzy Wavelet Network, finally obtain the tremble estimated value of signal of current time through obfuscation, fuzzy rule coupling, fuzzy reasoning and defuzzification
With the superimposed quasiexpectation operation signal y (k) that has just obtained preceding moment hand of the operation signal s (k) of the estimated value negate of this signal that trembles and the actual output of preceding moment hand.Sef-adapting filter among the present invention is the signal power E[y that calculates the quasiexpectation signal y (k) of current time hand by statistical module
2(k)], be that the parameter that criterion is revised in the Fuzzy Wavelet Network realizes the self study process to minimize this signal power.
Fig. 4 is described Fuzzy Wavelet Network adaptive-filtering figure.This Fuzzy Wavelet Network combines fuzzy theory, wavelet analysis and neuron computes, has brought into play it to the advantage of neutral signal modeling study at random, has reached ideal filter effect.Designed in the present invention network structure is seven layers.Specific as follows:
1) input layer (ground floor)
N+1 neuron arranged in this layer, corresponding input signal be actual disturbed signal and its time delayed signal promptly: s (k), s (k-1) ..., s (k-n), they will directly be sent down to one deck, that is:
Wherein
, s (k-n)] and be the input signal of ground floor, O
i (1)Represent the output signal of ground floor.The neuron number of this layer is n+1 altogether.
2) obfuscation layer (second layer)
This layer is that input quantity is carried out Fuzzy processing.We adopt the Gaussian function as membership function at this, c
IjAnd σ
IjBe respectively the average and the standard deviation of the membership function of i input variable and j fuzzy set, that is:
I=1 wherein, 2 ..., n+1 j=1,2 ..., m, O
Ij (2)Represent the output signal of the second layer.The neuron number of this layer is (n+1) * m altogether.
3) fuzzy rule layer (the 3rd layer)
Each node of this layer has all been represented a fuzzy rule, and each node j is output as the product of these all input signals of node, that is:
J=1 wherein, 2 ..., N, N=m
(n+1)Be the fuzzy rule number of this layer, O
j (3)Represent trilaminar output signal.The neuron number of this layer is N altogether.
4) wavelet network layer (the 4th layer)
This layer is a wavelet network, adopts Mexico's straw hat wavelet function as neuronic excitation function, and input quantity is s (k), s (k-1) ..., s (k-n), output are the consequent part y of fuzzy rule
l(l＝1，2，…，N)
Mexico's straw hat wavelet function:
A wherein
jAnd b
jRepresent the expansion parameter and the translation parameters of wavelet function respectively, ψ
j(x) represent wavelet function family,
Represent wavelet mother function, x is an input variable, x=[s in invention (k), and s (k-1) ..., s (k-n)].
L wavelet network is output as:
Z wherein
Kl=(X-b
Kl)/akl,
K=1 in invention, 2 ..., on behalf of each wavelet network, v, v contain the number of wavelet function.L=1,2 ..., N, N represent the number of wavelet network, ω
Kl, O
l (4)Be respectively the weights and the output of wavelet network layer.
5) fuzzy reasoning layer (layer 5)
This layer by with the coupling of finishing fuzzy rule layer and being connected of wavelet network layer the front and back part of fuzzy rule, realize fuzzy operation between each node, i.e. combination by each fuzzy node obtains corresponding ignition intensity.Each node j is output as the product of these all input signals of node, that is:
J=1 wherein, 2 ... N, O
j (5)Represent the output of fuzzy reasoning layer.
6) reconstruction of layer (layer 6)
This layer only contains two neurons, and they represent fuzzy reasoning computing the normalization molecule and the denominator part of arithmetic expression afterwards respectively.Each neuron is realized the function of summation.That is:
The number of N delegate rules wherein, O
1 (6), O
2 (6)Represent the molecule and the denominator part of arithmetic expression respectively.
7) output layer (layer 7)
This layer is the output of whole network, only contains a neuron, realization be division function.That is:
O wherein
(7)Being the output of FWNN, also is the tremble estimated value of signal of current time
Described Fuzzy Wavelet Network study mechanism is the signal power E[y that calculates the quasiexpectation operation signal y (k) of preceding hand constantly by statistical module by described
2(k)], be that the parameter that criterion is revised in the Fuzzy Wavelet Network realizes to minimize this signal power.Sef-adapting filter makes E[y
2(k)] minimum makes exactly
Minimum.And by formula
Can release and work as
Hour, E[(y (k)-d (k))
2] also be minimum, promptly
Minimum.The parameter that needs in the present invention to revise has: the average c in the Gaussian membership function
IjAnd variances sigma
IjThe weights ω of wavelet network
Kl, expansion parameter a
KlWith translation parameters b
Kl(i=1,2 ..., n+1, j=1,2 ..., m, k=1,2 ..., v, l=1,2 ..., N) the renewal equation formula of these parameters is as follows:
Wherein γ is a learning rate, γ ∈ [0,1], and λ is a factor of momentum, λ ∈ [0,1].
In the following formula
Provide by following equation, that is:
The equation of enumerating has above been finished parameter c
Ij, σ
Ij, ω
Kl, a
KlAnd b
KlStudy.
So far realized that adaptive filter device of the present invention is to the tremble filtering of behavior of operation operator hand.Below we verify the performance of the behavior of trembling adaptive filter device proposed by the invention with emulation experiment.
The present invention comes the observation experiment result by MATLAB emulation.The purpose of the present invention's experiment is the adaptive filter device of a kind of master-slave minimally-invasive surgery robot system more proposed by the invention and traditional performance based on BP neutral net adaptive filter device, verifies the filtering performance of the behavior adaptive filter device that trembles of the present invention.We adopt d=3sin (15 π t)+2cos (3 π t)+5t in this experiment
4-0.8t
3-2t is as operation technique person hand desired signal, with the tremble signal of n=0.3sin (0.04 π t)+0.1sin (0.0312 π t)+0.6sin (0.1 π) as operator's hand.Get sampling period T=0.01s, the sampling time is 10s, takes 1000 samples altogether, and wherein 500 samples are used for training, and 500 are used for test.In this experiment the partial parameters in the FWNN sef-adapting filter we be provided with as follows: n=2, m=3, v=4, N=27.
Fig. 5 and Fig. 6 are respectively the operation technique signal of expectation and the practical operation signal that is trembled and influence.As can be seen from Figure 6 trembling of operator's hand badly influenced the operation of operation, must this carry out high accuracy and the reliability of Filtering Processing to guarantee Minimally Invasive Surgery.
Fig. 7 can clearly compare the error that adaptive filter device proposed by the invention and traditional BP neutral net wave filter approach trembling.Wherein on behalf of BP neutral net sef-adapting filter, black dotted lines follow the tracks of to tremble the error of signal, and solid black lines is represented the tremble error of signal of FWNN filter tracks.
Fig. 8 and Fig. 9 contrast the recovering signal characteristic of filter proposed by the invention and traditional BP neutral net sef-adapting filter.The signal that restores than BP neutral net sef-adapting filter of the signal that restores of FWNN sef-adapting filter is Paint Gloss and near desired signal as can be seen.
Claims (10)
1. the adaptive filter device of a master-slave minimally-invasive surgery robot system, it is characterized in that including the behavior adaptive filter device (1) that trembles, main manipulator (2), station acquisition module (3), motion-control module (4), from operator driver module (5), detection module (6), from operator (7), feedback module (8) and computer control system (9), the operation signal that the operator sends obtains the quasiexpectation operation signal via the behavior adaptive filter device (1) that trembles, and by quasiexpectation signal driving main manipulator (2) action, the station acquisition module (3) that links to each other with main manipulator (2) is gathered the main manipulator spatial positional information, again this positional information is sent to motion-control module (4), by the processing of computer control module (9) assisted movement control module (4) realization to the main manipulator spatial positional information, and send from the control signal of operator (7), this control signal is amplified rear drive through the operator driver module (5) of associating and is moved from operator (7), detection module (6) detects the electric current of motor from operator driver module (5), speed and positional information, and feeding back to motion-control module (4) to realize closed loop control from operator (7), computer control module (9) realizes and trembles behavior adaptive filter device (1), communication and monitoring between motion-control module (4) and the feedback module (8).
2. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 1 is characterized in that the above-mentioned behavior adaptive filter device (1) that trembles comprises inertia measurement module (11), the filtration module that trembles (12), s operation control module (13) and main manipulator driver module (14); The locus acceleration and the joint angle velocity information of inertia measurement module (11) detecting operation person hand, and this is transferred to s operation control module (13), by s operation control module (13) position acceleration signal and joint angle rate signal are converted to locus signal and joint angles signal respectively, and send this to filtration module that trembles (12), the filtering of trembling again by the filtration module that trembles (12) realization, and obtain the quasiexpectation operation signal, again this quasiexpectation operation signal being input to s operation control module (13) handles, and obtaining a driving signal, this driving signal drives main manipulator via main manipulator driver module (14).
3. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 2 is characterized in that above-mentioned inertia measurement module (11) comprises the three-dimensional acceleration sensing module person's hand that is used to measure the operation technique at spatial three-dimensional position acceleration promptly:
Three dimensional angular velocity pick-up module is used to measure operation technique person's hand is in spatial orientation promptly:
4. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 2 is characterized in that the above-mentioned filtration module that trembles (12) adopts Fuzzy Wavelet Network (FWNN) the sef-adapting filter filtering operator hand signal that trembles to reduce its desired signal; Described Fuzzy Wavelet Network (FWNN) sef-adapting filter obtains compensating signal x ', y ', z ' and θ identical with tremble signal amplitude and frequency but that phase place is opposite based on Fuzzy Wavelet Network to the modeling of the signal that trembles
x', θ
y', θ
z'.Described Fuzzy Wavelet Network comprises obfuscation, fuzzy rule coupling, fuzzy reasoning and the defuzzification of input quantity to the modeling process of the signal that trembles; Fuzzy Wavelet Network comprises seven layers; Input layer, obfuscation layer, fuzzy rule layer, wavelet network layer, fuzzy reasoning layer, reconstruction of layer and output layer.
5. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 2 is characterized in that above-mentioned s operation control module (13) comprises AD conversion unit (131), D/A conversion unit (132), bandwidth filter (133), pose collecting unit (134), inverse kinematics computing unit (135) and simple joint control unit (136); This s operation control module (13) and computer control system (9) two-way communication, to realize computing and control function, AD conversion unit (131) will change digital signal into by the hand analogue signal (position acceleration signal and joint angle rate signal) that inertia measurement module (11) is gathered, repeated transmission is given bandwidth filter (133), clocking noise signal with filtering inertia measurement module (11) generation, pose collecting unit (134) will be locus signal and angle signal through the digital signal transition after bandwidth filter (133) is handled, and send the filtration module that trembles (12) to and carry out Filtering Processing, the quasiexpectation signal that inverse kinematics computing unit (135) is exported the filtration module that trembles (12) carries out inverse kinematics and calculates joint variable, control this joint variable by simple joint control unit (136), and output changes this control signal into analogue signal by D/A conversion unit (132) again and directly sends main manipulator driver module (14) to drive main manipulator the control signal of main manipulator.
6. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 2, it is characterized in that above-mentioned main manipulator driver module (14) comprises power amplifier (141) and Piexoelectric actuator (142), in order to drive main manipulator, make it desired track action according to the operation technique person; Comprise driver (51), motor (52) and actuating device (53) from operator driver module (5), realize the DSP control module and from the driving between the operator.
7. according to the adaptive filter device of each described master-slave minimally-invasive surgery robot system of claim 1 to 6, it is characterized in that above-mentioned main manipulator (2) directly is connected with the behavior adaptive filter device (1) that trembles, realize the human computer conversation between operation technique person and the minimally-invasive surgery robot system; Above-mentioned station acquisition module (3) realizes the collection to the positional information of main manipulator, quantizes the movement locus of main manipulator, and the positional information of gathering is directly imported into motion-control module; Above-mentioned motion-control module (4) adopts dsp controller to realize three closed loop controls and PWM control; The outer shroud of described three closed loop controls is the Position Control ring, and innermost ring is a current regulator, and a middle ring is the speed controlling ring, described dsp controller and computer control system realization two-way communication.
8. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 7, it is characterized in that above-mentioned detection module (6) realization detects and provide the closed loop feedback signal of three closed loop controls, comprises A/D converter (61), current sensor (62), photoelectric encoder (63), QEP circuit (64) and frequency measurement circuit (65); The pulse signal of the photoelectric encoder on the machine shaft (63) output is transferred to QEP circuit (64) and frequency measurement circuit (65), pulse signal is handled through QEP circuit (64) and is obtained position feed back signal, and send Position Control ring in the motion-control module (4) to, pulse signal is handled through frequency measurement circuit, obtain feedback speed signal, and send rate control module in the motion-control module (4) to, current sensor (62) detects the motor winding current, and obtain its digital current signal by A/D converter (61), again it is sent to the current regulator in the motion-control module (4).
9. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 8, it is characterized in that above-mentionedly getting in touch a closest unit for the most key the minimally invasive surgical operation robot system with the patient from operator (7), operating theater instruments is housed on it, and finishes the master-slave mode micro-wound surgical operation thus; Above-mentioned feedback module (8) is realized the supervision of minimal invasive surgical procedures and real-time information feedback by the graphics processing unit in endoscope and monitor and the computer control system, and making whole master-slave mode minimally invasive surgical operation robot system is a closed-loop control system.
10. the adaptive filter device of master-slave minimally-invasive surgery robot system according to claim 9 is characterized in that aforementioned calculation machine control system (9) comprises communication unit (91), Operations Analysis (92) and graphics processing unit (93); Described Operations Analysis (92) and filter module (1) two-way communication realize the computings such as digital-to-analogue conversion, analog digital conversion, inverse kinematics calculating in the filtration module (1), and the simple joint controller is monitored; Motion-control module (4) is realized the transmission of data through communication unit (91) and computer control system (9); Graphics processing unit (93) is accepted the image information of endoscope (81) output in the feedback module (8), this is handled and sends to the monitor (82) in the feedback module (8); Described Operations Analysis (92) is all realized by communication unit (91) with communicating by letter of other intermodules with graphics processing unit (93).
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010100194526A CN101785704B (en) | 2010-01-15 | 2010-01-15 | Self-adaptive filtering device of master-slave minimally-invasive surgery robot system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2010100194526A CN101785704B (en) | 2010-01-15 | 2010-01-15 | Self-adaptive filtering device of master-slave minimally-invasive surgery robot system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101785704A true CN101785704A (en) | 2010-07-28 |
| CN101785704B CN101785704B (en) | 2012-06-06 |
Family
ID=42529187
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010100194526A Expired - Fee Related CN101785704B (en) | 2010-01-15 | 2010-01-15 | Self-adaptive filtering device of master-slave minimally-invasive surgery robot system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN101785704B (en) |
Cited By (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103648428A (en) * | 2011-05-12 | 2014-03-19 | 帝国创新技术有限公司 | Medical master/slave type device for minimally invasive surgery |
| CN104736303A (en) * | 2012-10-19 | 2015-06-24 | 株式会社神户制钢所 | Weaving control device of multi-joint robot |
| CN105636542A (en) * | 2013-10-01 | 2016-06-01 | Abb高姆技术有限责任公司 | Control device and method for controlling a robot system by means of gesture control |
| CN106002910A (en) * | 2016-06-15 | 2016-10-12 | 重庆金山科技（集团）有限公司 | Master and slave control system and method for surgery robot |
| CN106041912A (en) * | 2016-06-16 | 2016-10-26 | 深圳先进技术研究院 | Master-slave mode snake-like robot system and position control method thereof |
| CN103870718B (en) * | 2014-04-11 | 2017-02-15 | 成都信息工程学院 | Inverse kinematic solving method based on neural network |
| CN107307910A (en) * | 2017-07-31 | 2017-11-03 | 成都中科博恩思医学机器人有限公司 | Joystick for manipulating executing agency |
| CN107361848A (en) * | 2017-07-31 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | The joystick of executing agency |
| CN109002948A (en) * | 2018-10-29 | 2018-12-14 | 中冶赛迪电气技术有限公司 | The short-term photovoltaic power generation power prediction method of micro-capacitance sensor based on CDA-BP |
| CN109316239A (en) * | 2018-08-31 | 2019-02-12 | 天津大学 | Micro-wound operation robot main manipulator and system based on magnetic navigation sensing |
| CN109352644A (en) * | 2018-09-14 | 2019-02-19 | 天津大学 | Manipulator motion rhythm detection method based on CPG neuroid |
| CN111588472A (en) * | 2020-04-13 | 2020-08-28 | 微创（上海）医疗机器人有限公司 | Surgical robot system |
| CN113103205A (en) * | 2021-04-16 | 2021-07-13 | 山东大学 | Control method and system for inhibiting tail end vibration of master-slave robot mechanical arm |
| US11344374B2 (en) | 2018-08-13 | 2022-05-31 | Verily Life Sciences Llc | Detection of unintentional movement of a user interface device |
| CN115607297A (en) * | 2022-10-19 | 2023-01-17 | 山东大学 | Tremor-suppression master-slave surgical robot control system and method |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1915963A1 (en) * | 2006-10-25 | 2008-04-30 | The European Atomic Energy Community (EURATOM), represented by the European Commission | Force estimation for a minimally invasive robotic surgery system |
-
2010
- 2010-01-15 CN CN2010100194526A patent/CN101785704B/en not_active Expired - Fee Related
Cited By (23)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103648428B (en) * | 2011-05-12 | 2016-01-13 | 帝国创新技术有限公司 | For the medical master/slave type device of Minimally Invasive Surgery |
| CN103648428A (en) * | 2011-05-12 | 2014-03-19 | 帝国创新技术有限公司 | Medical master/slave type device for minimally invasive surgery |
| CN104736303A (en) * | 2012-10-19 | 2015-06-24 | 株式会社神户制钢所 | Weaving control device of multi-joint robot |
| CN104736303B (en) * | 2012-10-19 | 2016-12-14 | 株式会社神户制钢所 | The oscillating control device of articulated robot |
| CN105636542A (en) * | 2013-10-01 | 2016-06-01 | Abb高姆技术有限责任公司 | Control device and method for controlling a robot system by means of gesture control |
| CN103870718B (en) * | 2014-04-11 | 2017-02-15 | 成都信息工程学院 | Inverse kinematic solving method based on neural network |
| CN106002910A (en) * | 2016-06-15 | 2016-10-12 | 重庆金山科技（集团）有限公司 | Master and slave control system and method for surgery robot |
| CN106041912B (en) * | 2016-06-16 | 2018-06-22 | 深圳先进技术研究院 | Master-slave mode snake-shaped robot system and its position control method |
| CN106041912A (en) * | 2016-06-16 | 2016-10-26 | 深圳先进技术研究院 | Master-slave mode snake-like robot system and position control method thereof |
| CN107307910A (en) * | 2017-07-31 | 2017-11-03 | 成都中科博恩思医学机器人有限公司 | Joystick for manipulating executing agency |
| CN107361848A (en) * | 2017-07-31 | 2017-11-21 | 成都中科博恩思医学机器人有限公司 | The joystick of executing agency |
| CN107307910B (en) * | 2017-07-31 | 2023-09-05 | 成都博恩思医学机器人有限公司 | Control handle for actuating an actuator |
| CN107361848B (en) * | 2017-07-31 | 2023-05-16 | 成都博恩思医学机器人有限公司 | Control handle of actuating mechanism |
| US11344374B2 (en) | 2018-08-13 | 2022-05-31 | Verily Life Sciences Llc | Detection of unintentional movement of a user interface device |
| CN109316239A (en) * | 2018-08-31 | 2019-02-12 | 天津大学 | Micro-wound operation robot main manipulator and system based on magnetic navigation sensing |
| CN109316239B (en) * | 2018-08-31 | 2020-08-04 | 天津大学 | Minimally invasive surgery robot main manipulator and system based on magnetic navigation sensing |
| CN109352644B (en) * | 2018-09-14 | 2021-08-03 | 天津大学 | Mechanical arm movement rhythm control method based on CPG (coherent population) neuron network |
| CN109352644A (en) * | 2018-09-14 | 2019-02-19 | 天津大学 | Manipulator motion rhythm detection method based on CPG neuroid |
| CN109002948A (en) * | 2018-10-29 | 2018-12-14 | 中冶赛迪电气技术有限公司 | The short-term photovoltaic power generation power prediction method of micro-capacitance sensor based on CDA-BP |
| CN111588472A (en) * | 2020-04-13 | 2020-08-28 | 微创（上海）医疗机器人有限公司 | Surgical robot system |
| CN113103205A (en) * | 2021-04-16 | 2021-07-13 | 山东大学 | Control method and system for inhibiting tail end vibration of master-slave robot mechanical arm |
| CN115607297A (en) * | 2022-10-19 | 2023-01-17 | 山东大学 | Tremor-suppression master-slave surgical robot control system and method |
| CN115607297B (en) * | 2022-10-19 | 2024-04-30 | 山东大学 | Master-slave operation robot control system and method for tremor suppression |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101785704B (en) | 2012-06-06 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101785704B (en) | Self-adaptive filtering device of master-slave minimally-invasive surgery robot system | |
| Bi et al. | A review on EMG-based motor intention prediction of continuous human upper limb motion for human-robot collaboration | |
| US10959863B2 (en) | Multi-dimensional surface electromyogram signal prosthetic hand control method based on principal component analysis | |
| CN105213153A (en) | Based on the lower limb rehabilitation robot control method of brain flesh information impedance | |
| Tatinati et al. | Multistep prediction of physiological tremor based on machine learning for robotics assisted microsurgery | |
| Liu et al. | Adaptive least squares support vector machines filter for hand tremor canceling in microsurgery | |
| Meng et al. | Active interaction control applied to a lower limb rehabilitation robot by using EMG recognition and impedance model | |
| Pang et al. | Electromyography-based quantitative representation method for upper-limb elbow joint angle in sagittal plane | |
| CN101972170B (en) | Self-adapting filter for least square support vector machine and filtering method thereof | |
| Chai et al. | A novel method based on long short term memory network and discrete-time zeroing neural algorithm for upper-limb continuous estimation using sEMG signals | |
| Liu et al. | Adaptive fuzzy wavelet neural network filter for hand tremor canceling in microsurgery | |
| Sun et al. | Real-time human intention recognition of multi-joints based on MYO | |
| CN201814653U (en) | Self-adapting filter of master-slave minimally invasive surgery robot system | |
| Pham et al. | Extraction and implementation of muscle synergies in neuro-mechanical control of upper limb movement | |
| Shen et al. | STMI: Stiffness estimation method based on sEMG-driven model for elbow joint | |
| Zhang et al. | The design of a hemiplegic upper limb rehabilitation training system based on surface EMG signals | |
| Yan et al. | UKF-based motion estimation of cable-driven forceps for robot-assisted surgical system | |
| CN108994833A (en) | A kind of joint assistance control method based on myoelectricity liveness feedback | |
| CN116869777A (en) | Upper limb full-period rehabilitation training device for cerebral apoplexy patient | |
| Stroh et al. | Hand gesture-based artificial neural network trained hybrid human–machine interface system to navigate a powered wheelchair | |
| Li et al. | Variable stiffness control for SEAs in rehabilitation training | |
| Ohara et al. | Tremor suppression control of meal-assist robot with adaptive filter | |
| Zheng et al. | Fuzzy adaptive sliding mode impedance control of fracture reduction robot | |
| Wang et al. | Interval estimation of motion intensity variation using the improved inception-V3 model | |
| Nasr et al. | Robust machine learning mapping of sEMG signals to future actuator commands in biomechatronic devices |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120606 Termination date: 20130115 |