CN103809439A - Hierarchical identification method applicable to control parameters of teleoperation system - Google Patents
Hierarchical identification method applicable to control parameters of teleoperation system Download PDFInfo
- Publication number
- CN103809439A CN103809439A CN201410012676.2A CN201410012676A CN103809439A CN 103809439 A CN103809439 A CN 103809439A CN 201410012676 A CN201410012676 A CN 201410012676A CN 103809439 A CN103809439 A CN 103809439A
- Authority
- CN
- China
- Prior art keywords
- iph
- submodel
- parameter
- jqh
- output
- 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
Abstract
The invention relates to a hierarchical identification method applicable to the control parameters of a teleoperation system. The method comprises the steps of simplifying a teleoperation process in which input and output signals are sampled differently into a dual-rate sampling system, building an auxiliary model based on a minimal sampling period by using a re-sampling method, and estimating the middle state value of the re-sampling system; an output sampling period is greater than a re-sampling period, and the middle state value can not be directly corrected by the output estimated differential value of the system, so that the state estimation value in a Kalman forecasting process can be modified by adopting a state changing difference value, i.e. a differential method. According to the method, the parameters of the dual-rate teleoperation system can be identified under the two conditions of known and unknown state values, so that the feasibility and effectiveness of the method can be verified by a simulation result.
Description
Technical field
The invention belongs to system control parameters identification field, be specifically related to a kind of be applicable to remote control system control parameter pass rank discrimination method.
Background technology
Two rate systems are general designations of the system different with output sampling frequency rate to input sample frequency.Two rate systems are not only widely used in Chemical Engineering Process Control field, also have great importance in spationautics application, for example, in the distant operating process in space, input control signal by main side is to controlling from the space manipulator of end, input control signal is position and the torque signals of main side hand controller, output feedback signal comprises the position at the distant shoulder joint place of operating machines, speed and torque signals etc., generally, main side control signal frequency ratio receives the frequency of feedback signal and wants high, this one side is relevant with the ability of the processing signals of spaceborne computer, also relevant with sample frequency and the information capacity of sensor on the other hand, can be by a pair of rate that the is reduced to system of this distant operating process according to input control signal and output feedback signal, thereby carry out identification by the control parameter to this system and draw the control output relation of distant operating process.
The discrimination method that is directed at present many rates system and two rate systems mainly contains: strong fraction transfer function model discrimination method, frequency-domain model discrimination method, wavelet model discrimination method, Stute space model identification method etc.Wherein, state-space method is an important method in two rate identifications, it is mainly can not be directly used in identification for two rate data in discrete state spatial model, constant single rate system model when two rate sampling systems being converted into by " lift technique ", and with reference to MOESP, the subspace state space system identification such as N4SID and CAV carries out identification to systematic parameter, although LPTV is converted into LTI system by lift technique, the direct application of conveniently recognized method, but also can cause the undesirable of the increase of number of parameters to be identified and calculated amount and identification precision, in addition, framework identified parameters cycle length of " lifting " once, can cause like this convergent cycle of identified parameters long, speed of convergence is slower.Therefore, needing a new method to solve utilizes lift technique to carry out to two rate systems the problem that parameter identification faces.
Summary of the invention
The technical matters solving
For fear of the deficiencies in the prior art part, the present invention propose a kind of be applicable to remote control system control parameter pass rank discrimination method.
Technical scheme
What be applicable to remote control system control parameter passs a rank discrimination method, it is characterized in that step is as follows:
Step 1: gather distant operation input control signal and output feedback signal, described input control signal is position and the torque signals of main side hand controller; Described output feedback signal comprises position, speed and the torque signals at the distant shoulder joint place of operating machines;
Distant operating process is reduced to a pair of rate system model, and its state-space model is:
Wherein, A, B, C, D are systematic parameter, and K represents the K time sampling of system, and x (K) is state value, and u (K) is input signal, and y (K) is output signal;
The control inputs sampling period that makes system is T
1with output sampling period be T
2, h is T
1and T
2highest common factor, T
1and T
2meet: T
1=ph, T
2=qh and p and q two numbers are relatively prime, and w (K) and v (K) represent respectively process noise and measurement noise, and the system model of system is:
Wherein, a, b, c, d are submodel parameter, the k time sampling that k is submodel, and r (kh) and v (kh) are respectively submodel process noise and measure noise;
Parameters relationship between two models is:
Step 2: make its expression formula of residual values o (kh) be:
Its update cycle is identical with the cycle qh of output variable y (kh), varivance matrix and error covariance matrix expression are M (kh)=x (kh) x (kh-h), P (kh)=x (kh) x (kh), wherein x (kh)=x (kh)-x (kh), x (kh) is the estimated value of x (kh), order
utilization pushes through recurrence equation:
Wherein, a (kh),
d (kh) is respectively the estimated value of a (kh), b (kh), a (kh), d (kh), and the more new formula of Kalman filtering gain matrix L (kh), L1 (kh), P (kh) and M (kh) is:
Wherein, cov (o (kh), o (kh)
t)=Ro δ
ij, cov (r (kh), r (kh)
t)=Rr δ
ij, wherein, cov () represents covariance computing, δ
ijfor kronecker-δ function, K1 is constant, and the state value that further obtains submodel is estimated:
Obtain the input and output state moment state estimation value of original system according to the parameter corresponding relation of two rate remote control systems and submodel: x (KT
1)=x (Kph), x (KT
2)=x (Kqh);
Step 3: the state value doping according to submodel is passed rank parameter identification to two rate remote control systems, and expression is as follows:
Wherein, i, j represents respectively the sampling instant of input and output signal,
θ
x(iph)=[A(iph),B(iph)]
T,
θ
i(jqh)=[C(jqh),D(jqh)]
T,
X(iph+ph)=x(iph+ph),
A (iph), B (iph), C (jqh), D (jqh) represent respectively the estimated value of A (iph), B (iph), C (jqh), D (jqh);
Obtain again the parameter of next step submodel system according to the result of passing rank identification:
Step 4: circulation step 2 and step 3 are passed rank parameter identification process until complete all two rate remote control systems.
In described step 2, Ro and Rr estimate by following formula:
Wherein,
L represents the data length of data r (kh) or o (kh).
Beneficial effect
The present invention proposes a kind of be applicable to remote control system control parameter pass rank discrimination method, the input/output signal different distant operating process of sampling is reduced to a pair of rate sampling system, utilize the method for resampling to set up a cycle submodel based on minimum sampling, and estimate the intermediateness value of resampling system with this, because the output sampling period is greater than the resampling cycle, the output estimation difference of system can not directly be revised intermediateness value, so having adopted state variation difference is herein that the method for difference is revised the state estimation value in Kalman Prediction process, the present invention can carry out identification to the two rate remote control system parameters in the known and unknown two kinds of situations of state value, simulation results show feasibility and the validity of the method.
The invention has the beneficial effects as follows: distant operating process is reduced to two rate sampling system model, promoting variable for traditional lift technique exists identified parameters more in the method for identification again, the problems such as the large and identification precision of calculated amount is undesirable, the present invention is estimation procedure state value effectively, and reduce calculated amount and computing time, than former method, calculation procedure is simple, is convenient to apply in engineering.There is good accuracy, robustness and validity through simulating, verifying this method.
Accompanying drawing explanation
What Fig. 1 was applicable to remote control system control parameter passs rank discrimination method
The process flow diagram of Fig. 2 submodel state-updating
Fig. 3 Parameter identification process
Fig. 4 Parameter identification result
embodiment
Now in conjunction with the embodiments, the invention will be further described for accompanying drawing:
As shown in Figure 1, it comprises following four steps to the process flow diagram of the embodiment of the present invention:
Step 1: distant operation input control signal and output feedback signal are gathered, input control signal is position and the torque signals of main side hand controller, output feedback signal comprises position, speed and the torque signals etc. at the distant shoulder joint place of operating machines, ignore the impact of system time delay and consider that the sample frequency of output feedback signal is lower than the frequency of input control signal, after input/output signal is processed, distant operating process is reduced to a pair of rate system model, its state-space model is:
Wherein, A, B, C, D are systematic parameter, and K is for representing the K time sampling, and x (K) is state value, and u (K) is input signal, and y (K) is output signal, and the control inputs sampling period that makes system is T
1with output sampling period be T
2, h is T
1and T
2highest common factor, T
1and T
2expression formula be T
1=ph, T
2=qh and p and q two numbers are relatively prime, w (K) and v (K) represent respectively process noise and measure noise, and it is all zero-mean white noise sequence stably, meet: E (w (i))=0, E (v (i))=0cov (w (i), w (j)
t)=Rw δ
ij, cov (v (i), v (j)
t)=Rv δ
ij, cov () represents covariance computing, δ
ijfor kronecker-δ function.Set up the submodel that has same structure with former pair of rate discrete system:
Wherein, a, b, c, d are submodel parameter, the k time sampling that k is submodel, and r (kh) and v (kh) are respectively submodel process noise and measure noise, output sampling period T
1be greater than input refresh cycle T
2, meet p < q, by system (1) and system (2) coefficient of correspondence under the framework cycle equate, can obtain submodel coefficient:
Step 2, submodel state estimation.Its process flow diagram is as shown in Figure 2:
First, calculate the residual values of submodel, the update cycle of residual values o (kh) is identical with the cycle qh of output variable y (kh), and its expression formula is:
Its update cycle is identical with the cycle qh of output variable y (kh), varivance matrix and error covariance matrix expression are M (kh)=x (kh) x (kh-h), P (kh)=x (kh) x (kh), wherein x (kh)=x (kh)-x (kh), x (kh) is the estimated value of x (kh), order
utilization pushes through recurrence equation:
Wherein, a (kh),
d (kh) is respectively the estimated value of a (kh), b (kh), a (kh), d (kh), and the more new formula of Kalman filtering gain matrix L (kh), L1 (kh), P (kh) and M (kh) is:
Wherein, cov (o (kh), o (kh)
t)=Ro δ
ij, cov (r (kh), r (kh)
t)=Rr δ
ij, wherein δ i
jfor kronecker-δ function, K1 is constant, and the state value that further obtains submodel is estimated:
The last parameter corresponding relation according to two rate systems and submodel obtains the input and output state moment state estimation value of former pair of rate system: x (KT
1)=x (Kph), x (KT
2)=x (Kqh).
Step 3: two rate remote control system parameters pass rank identification.Adopt the method for passing rank identification to carry out identification for two rate remote control system parameters, detailed process is as follows:
Wherein, i, j represents respectively the sampling instant of input and output signal,
θ
x(iph)=[A(iph),B(iph)]
T,
θ
i(jqh)=[C(jqh),D(jqh)]
T,
X(iph+ph)=x(iph+ph),
A (iph), B (iph), C (jqh), D (jqh) represent respectively the estimated value of A (iph), B (iph), C (jqh), D (jqh).And then obtain the parameter of next step submodel system according to the result of passing rank identification:
Step 4: the formula (3) in circulation step 2 and step 3 to formula (17) until complete two rate remote control system parameters pass rank identification process.
In step 2, Ro and Rr estimate by following formula:
Wherein,
L represents the data length of data r (kh) or o (kh).
For method of the present invention, carry out simulating, verifying, the state space equation of the two rate remote control systems of order is as follows:
Wherein, input sample cycle T
1=3h, the output sampling period is T
2=4h, h=1s, framework period p qh=12h, input signal is quasi stationary sequence E[u (k)]=1.5, system noise and measurement noise are respectively Rw=0.05
2, Rv=0.05
2, system (18) submodel data length to be identified is 10000.The parameter of system is carried out to identification, and as shown in Figure 3, Figure 4, simulation result shows for identification process and result, and the present invention can effectively carry out identification to systematic parameter at state value under known and unknown situation, and speed of convergence is very fast, and calculated amount is little, and identification result is accurate.
Claims (2)
1. what be applicable to remote control system control parameter passs a rank discrimination method, it is characterized in that step is as follows:
Step 1: gather distant operation input control signal and output feedback signal, described input control signal is position and the torque signals of main side hand controller; Described output feedback signal comprises position, speed and the torque signals at the distant shoulder joint place of operating machines;
Distant operating process is reduced to a pair of rate system model, and its state-space model is:
Wherein, A, B, C, D are systematic parameter, and K represents the K time sampling of system, and x (K) is state value, and u (K) is input signal, and y (K) is output signal;
The control inputs sampling period that makes system is T
1with output sampling period be T
2, h is T
1and T
2highest common factor, T
1and T
2meet: T
1=ph, T
2=qh and p and q two numbers are relatively prime, and w (K) and v (K) represent respectively process noise and measurement noise, and the system model of system is:
wherein, a, b, c, d are submodel parameter, the k time sampling that k is submodel, and r (kh) and v (kh) are respectively submodel process noise and measure noise;
Step 2: make its expression formula of residual values o (kh) be:
Its update cycle is identical with the cycle qh of output variable y (kh), varivance matrix and error covariance matrix expression are M (kh)=x (kh) x (kh-h), P (kh)=x (kh) x (kh), wherein x (kh)=x (kh)-x (kh), x (kh) is the estimated value of x (kh), order
utilization pushes through recurrence equation:
Wherein, a (kh),
d (kh) is respectively the estimated value of a (kh), b (kh), a (kh), d (kh), and the more new formula of Kalman filtering gain matrix L (kh), L1 (kh), P (kh) and M (kh) is:
Wherein, cov (o (kh), o (kh)
t)=Ro δ
ij, cov (r (kh), r (kh)
t)=Rr δ
ij, wherein, cov () represents covariance computing, δ
ijfor kronecker-δ function, K1 is constant, and the state value that further obtains submodel is estimated:
Obtain the input and output state moment state estimation value of original system according to the parameter corresponding relation of two rate remote control systems and submodel: x (KT
1)=x (Kph), x (KT
2)=x (Kqh);
Step 3: the state value doping according to submodel is passed rank parameter identification to two rate remote control systems, and expression is as follows:
Wherein, i, j represents respectively the sampling instant of input and output signal,
θ
x(iph)=[A(iph),B(iph)]
T,
θ
i(jqh)=[C(jqh),D(jqh)]
T,
X(iph+ph)=x(iph+ph),
A (iph), B (iph), C (jqh), D (jqh) represent respectively the estimated value of A (iph), B (iph), C (jqh), D (jqh);
Obtain again the parameter of next step submodel system according to the result of passing rank identification:
Step 4: circulation step 2 and step 3 are passed rank parameter identification process until complete all two rate remote control systems.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410012676.2A CN103809439B (en) | 2014-01-10 | 2014-01-10 | A kind of be applicable to remote control system controling parameters pass rank discrimination method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410012676.2A CN103809439B (en) | 2014-01-10 | 2014-01-10 | A kind of be applicable to remote control system controling parameters pass rank discrimination method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103809439A true CN103809439A (en) | 2014-05-21 |
CN103809439B CN103809439B (en) | 2016-04-06 |
Family
ID=50706389
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410012676.2A Active CN103809439B (en) | 2014-01-10 | 2014-01-10 | A kind of be applicable to remote control system controling parameters pass rank discrimination method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103809439B (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104899456A (en) * | 2015-06-15 | 2015-09-09 | 西北工业大学 | Real-time correction method for on-orbit spacecraft model |
CN105184073A (en) * | 2015-09-01 | 2015-12-23 | 西北工业大学 | Wave variable calculation method for variable advantage factor double teleoperation |
CN105204328A (en) * | 2015-09-01 | 2015-12-30 | 西北工业大学 | Teleoperation-oriented multi-operator synchronous training method |
CN105382841A (en) * | 2015-11-17 | 2016-03-09 | 西北工业大学 | Teleoperation double-side control method based on dual-channel communication |
CN107577147A (en) * | 2017-09-08 | 2018-01-12 | 北京邮电大学 | A kind of bilateral PID control method of remote operating based on self-adapting Smith predictor |
CN109968361A (en) * | 2019-05-17 | 2019-07-05 | 北京理工大学 | A kind of impedance remote operating control device and method based on Real-time force feedback |
CN110209482A (en) * | 2019-05-28 | 2019-09-06 | 北京国电智深控制技术有限公司 | A kind of dispatching method of periodic message and device, computer readable storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62154004A (en) * | 1985-12-26 | 1987-07-09 | Fanuc Ltd | Control system for robot arm |
JP2007282044A (en) * | 2006-04-10 | 2007-10-25 | Canon Inc | Control apparatus, method and program |
CN102773863A (en) * | 2012-07-31 | 2012-11-14 | 华南理工大学 | Fine-teleoperation method for robot |
CN102825603A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Network teleoperation robot system and time delay overcoming method |
CN103064420A (en) * | 2012-12-14 | 2013-04-24 | 西北工业大学 | Approaching posture coordination control method of space tether robot with movable tether point |
-
2014
- 2014-01-10 CN CN201410012676.2A patent/CN103809439B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62154004A (en) * | 1985-12-26 | 1987-07-09 | Fanuc Ltd | Control system for robot arm |
JP2007282044A (en) * | 2006-04-10 | 2007-10-25 | Canon Inc | Control apparatus, method and program |
CN102773863A (en) * | 2012-07-31 | 2012-11-14 | 华南理工大学 | Fine-teleoperation method for robot |
CN102825603A (en) * | 2012-09-10 | 2012-12-19 | 江苏科技大学 | Network teleoperation robot system and time delay overcoming method |
CN103064420A (en) * | 2012-12-14 | 2013-04-24 | 西北工业大学 | Approaching posture coordination control method of space tether robot with movable tether point |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104899456A (en) * | 2015-06-15 | 2015-09-09 | 西北工业大学 | Real-time correction method for on-orbit spacecraft model |
CN105184073A (en) * | 2015-09-01 | 2015-12-23 | 西北工业大学 | Wave variable calculation method for variable advantage factor double teleoperation |
CN105204328A (en) * | 2015-09-01 | 2015-12-30 | 西北工业大学 | Teleoperation-oriented multi-operator synchronous training method |
CN105382841A (en) * | 2015-11-17 | 2016-03-09 | 西北工业大学 | Teleoperation double-side control method based on dual-channel communication |
CN105382841B (en) * | 2015-11-17 | 2017-03-29 | 西北工业大学 | A kind of remote operating bilateral control method communicated based on the dual pathways |
CN107577147A (en) * | 2017-09-08 | 2018-01-12 | 北京邮电大学 | A kind of bilateral PID control method of remote operating based on self-adapting Smith predictor |
CN109968361A (en) * | 2019-05-17 | 2019-07-05 | 北京理工大学 | A kind of impedance remote operating control device and method based on Real-time force feedback |
CN110209482A (en) * | 2019-05-28 | 2019-09-06 | 北京国电智深控制技术有限公司 | A kind of dispatching method of periodic message and device, computer readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN103809439B (en) | 2016-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103809439A (en) | Hierarchical identification method applicable to control parameters of teleoperation system | |
CN104443427B (en) | Aircraft tremor prognoses system and method | |
CN105425587A (en) | Hysteresis nonlinear motor identification and control method | |
CN103406909B (en) | Tracking control device and method of mechanical arm system | |
CN104992164B (en) | A kind of dynamic oscillation signal model parameters discrimination method | |
CN108153259B (en) | Multi-controller optimal state estimation control strategy design method based on Kalman filtering | |
CN102930171B (en) | Nonlinear filtering method based on polytope differential inclusion | |
CN104898550A (en) | Dynamic servo system composite control method based on sliding mode extended state observer (SMESO) | |
CN105043388A (en) | Vector search iterative matching method based on inertia/gravity matching integrated navigation | |
CN104121907A (en) | Square root cubature Kalman filter-based aircraft attitude estimation method | |
CN104182609A (en) | Decorrelation based three-dimensional target tracking method for unbiased converted measurement | |
CN110955145A (en) | Five-order active disturbance rejection control method for continuous rotary motor electro-hydraulic servo system | |
CN104267596A (en) | Finite-time decoupling control method of cart inverted pendulum system | |
CN102999696A (en) | Capacity information filtering-based pure direction tracking method of noise-related system | |
CN108871365B (en) | State estimation method and system under course constraint | |
CN110677140B (en) | Random system filter containing unknown input and non-Gaussian measurement noise | |
CN105043384A (en) | Modeling method of gyroscopic random noise ARMA model based on robust Kalman wave filtering | |
CN104794332B (en) | A kind of Uncertainty Analysis Method of skyscraper wind-excited responese analysis model | |
CN106094526A (en) | A kind of method that Generalized Prediction through engineering approaches is applied to denitration control system | |
CN110702093B (en) | Particle filter-based positioning method and device, storage medium and robot | |
Bonvini et al. | An fmi-based framework for state and parameter estimation | |
CN101887260A (en) | Industrial process optimal control system and method for adaptive synchronization policy | |
CN101916394A (en) | Knowledge fusion-based online soft measurement method | |
CN104331630A (en) | State estimation and data fusion method for multi-rate observation data | |
CN101403924A (en) | Method for on-line delay detection of control loop |
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 |