CN105353616B - 一种基于波变量的定时延遥操作控制方法 - Google Patents
一种基于波变量的定时延遥操作控制方法 Download PDFInfo
- Publication number
- CN105353616B CN105353616B CN201510793832.8A CN201510793832A CN105353616B CN 105353616 B CN105353616 B CN 105353616B CN 201510793832 A CN201510793832 A CN 201510793832A CN 105353616 B CN105353616 B CN 105353616B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mover
- msup
- mfrac
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
Abstract
本发明公开了一种基于波变量的定时延遥操作控制方法,通过建立主从端的动力学模型及时延模型,设计前向通道波变量补偿项,设计反向通道波变量补偿项以及最后设计能量整定器,以解决遥操作中的时延带来的稳定性问题,同时提高遥操作过程中的跟踪性能和力反馈逼真度。本发明能够很好的保证遥操作系统在定时延条件下的稳定性,具有良好的位置跟踪性能和良好的力反馈逼真度;本发明所公开的遥操作控制方法通过波变量的方法,可以保证遥操作系统在时延情况下的稳定性,同时可以提高时延遥操作系统的位置和力的跟踪性能。
Description
【技术领域】
本发明属于遥操作控制领域,具体涉及一种基于波变量的定时延遥操作控制方法。
【背景技术】
遥操作已经在诸如空间机器人、高精度装配、手术等诸多领域扮演着重要角色。在遥操作系统中,操作者通过操作从端的机械臂与远端环境进行交互。遥操作可以给操作者提供一个安全的环境,同时具有很强的临场感。但是时延极大的影响到遥操作的稳定性,而时延又广泛存在于通信信道中。波变量方法脱胎于无源控制理论,可以很好的解决由时延带来的遥操作稳定性问题。
【发明内容】
本发明的目的在于解决遥操作中的时延带来的稳定性问题,一种基于波变量的定时延遥操作控制方法,该方法能够同时提高遥操作过程中的跟踪性能和力反馈逼真度。
为实现上述目的,本发明采用以下技术方案予以实现:
一种基于波变量的定时延遥操作控制方法,包括以下步骤:
1)建立主从端的动力学模型及时延模型:
其中,Mm表示主端质量,表示主端加速度,fh表示手施加给主端的力,fmc表示从端反馈到主端的控制力;Ms表示从端质量,表示从端加速度,fsc表示从端控制器产生的控制力,fe表示环境施加给从端的力;B和K分别表示从端控制器的微分参数和比例参数;表示主端传输到从端的期望速度,xsc表示主端传输到从端的期望位置,和分别表示主端和从端的实际速度,下标m表示主端,下标s表示从端;
期望的主端和从端之间的关系是:
Fmc(s)=Fsc(s)e-sT (1-5)
s表示拉普拉斯算子,分别表示主端和从端的速度的拉普拉斯变换,表示主端向从端传输信道中的低通滤波器,λ为滤波器的带宽,Fmc(s)表示从端反馈到主端的控制力的拉普拉斯变换;Fsc(s)表示从端控制力的拉普拉斯变换;e-sT表示定时延通信环节的拉普拉斯变换;
在信道传输过程中,采用波变量进行传输;在频域内的波变量变换公式如下:
其中,b为波变量参数,Um(s)表示主端的前向波变量的拉普拉斯变换,Vm(s)表示主端的反向波变量的拉普拉斯变换,Us(s)表示从端的前向波变量的拉普拉斯变换,Vs(s)表示从端的反向波变量的拉普拉斯变换,表示从端收到的主端传输的期望速度的拉普拉斯变换;
因为存在时延,建立如下的时延模型:
其中,T表示主端与从端之间的时延,均为常数;
2)设计前向通道波变量补偿项
加入补偿项后,前向通道的波变量如下:
其中,ΔUs(s)为前向通道波变量补偿量的拉普拉斯变换;
为了达到稳定的跟踪性能,补偿量如下所示:
3)设计反向通道波变量补偿项
对反向通道的波变量增加补偿项ΔVm(s),反向通道的波变量表示为:
Vm(s)=Vs(s)e-sT+ΔVm(s) (1-13)
其中,ΔVm(s)为反向通道波变量补偿量的拉普拉斯变换;
传递到主端的反馈力为:
将(1-13)与(1-9)带入(1-14),得到:
令:
则(1-15)中的就会被消掉,从而可以满足(1-5)的要求;
经过化简,得到:
ΔVm=Um-Use-sT (1-17)
4)设计能量整定器
为了对主端耗散的能量进行计算,设计一个非负能量储存器:
Es(t)表示能量存储量,um(τ)为主端前向波变量的时域信号,vs(τ)为从端反向波变量的时域信号。
反向通道的波变量补偿项Δvm(t)的计算方式如下:
其中,γ和δ都是正的调节参数,γ决定了补偿的快慢,δ决定了能量储存器的累积的快慢,*代表卷积运算;当能量储存器达到零时,上式小括号中的项就会成为零,从而会阻断补偿项的计算,很好的保证系统的稳定性。
与现有技术相比,本发明具有如下有益效果:
本发明通过建立主从端的动力学模型及时延模型,设计前向通道波变量补偿项,设计反向通道波变量补偿项以及最后设计能量整定器,以解决遥操作中的时延带来的稳定性问题,同时提高遥操作过程中的跟踪性能和力反馈逼真度。本发明能够很好的保证遥操作系统在定时延条件下的稳定性,具有良好的位置跟踪性能和良好的力反馈逼真度;本发明所公开的遥操作控制方法通过波变量的方法,可以保证遥操作系统在时延情况下的稳定性,同时可以提高时延遥操作系统的位置和力的跟踪性能。
【附图说明】
图1表示传统的基于波变量的遥操作系统结构示意图;
图2表示前向通道补偿的波变量遥操作系统结构示意图;
图3表示本发明的系统结构示意图。
【具体实施方式】
下面结合附图和实施例对本发明做进一步详细的说明。
参见图3,本发明基于波变量的定时延遥操作控制方法,包括以下步骤:
1)建立主端与从端的动力学模型:
其中Mm=1kg,Ms=1kg,B=80Ns/m,K=80N/m,fmc表示从端反馈到主端的控制力,fsc表示从端控制器产生的控制力,fh表示手施加给主端的力,fe表示环境施加给从端的力。表示主端传输到从端的期望速度,和分别表示主端和从端的实际速度,B和K分别表示从端控制器的微分参数和比例参数。下标m表示主端,下标s表示从端。
我们期望的主端和从端之间的关系是:
Fmc(s)=Fsc(s)e-sT (1-5)
分别表示主端和从端速度的拉普拉斯变换,表示主端向从端传输信道中的低通滤波器,λ为滤波器的截止频率,λ=15,Fmc(s)表示从端反馈到主端的控制力的拉式变换。
在信道传输过程中,采用波变量进行传输。在频域内的波变量变换公式如下:
其中b=2。
2)时延模型如下:
其中T=0.25s
3)为了达到稳定的跟踪性能,前向通道的波变量补偿量如下所示:
4)反向通道的补偿量如下:
ΔVm=Um-Use-sT (1-12)
5)能量整定器设计如下:
其中:δ=0.1,γ=0.1。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。
Claims (1)
1.一种基于波变量的定时延遥操作控制方法,其特征在于,包括以下步骤:
1)建立主从端的动力学模型及时延模型:
<mrow>
<msub>
<mi>M</mi>
<mi>m</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mi>h</mi>
</msub>
<mo>-</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>m</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>M</mi>
<mi>s</mi>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>s</mi>
</msub>
<mo>=</mo>
<msub>
<mi>f</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>f</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>f</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>B</mi>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>K</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>s</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,Mm表示主端质量,表示主端加速度,fh表示手施加给主端的力,fmc表示从端反馈到主端的控制力;Ms表示从端质量,表示从端加速度,fsc表示从端控制器产生的控制力,fe表示环境施加给从端的力;B和K分别表示从端控制器的微分参数和比例参数;表示主端传输到从端的期望速度,xsc表示主端传输到从端的期望位置,和分别表示主端和从端的实际速度,下标m表示主端,下标s表示从端;
期望的主端和从端之间的关系是:
<mrow>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mfrac>
<mi>&lambda;</mi>
<mrow>
<mi>s</mi>
<mo>+</mo>
<mi>&lambda;</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
Fmc(s)=Fsc(s)e-sT (1-5)
s表示拉普拉斯算子,分别表示主端和从端的速度的拉普拉斯变换,表示主端向从端传输信道中的低通滤波器,λ为滤波器的带宽,Fmc(s)表示从端反馈到主端的控制力的拉普拉斯变换;Fsc(s)表示从端控制力的拉普拉斯变换;e-sT表示定时延通信环节的拉普拉斯变换;
在信道传输过程中,采用波变量进行传输;在频域内的波变量变换公式如下:
<mrow>
<msub>
<mi>U</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>b</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>m</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>b</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>m</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>U</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>b</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<mrow>
<mi>b</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,b为波变量参数,Um(s)表示主端的前向波变量的拉普拉斯变换,Vm(s)表示主端的反向波变量的拉普拉斯变换,Us(s)表示从端的前向波变量的拉普拉斯变换,Vs(s)表示从端的反向波变量的拉普拉斯变换,表示从端收到的主端传输的期望速度的拉普拉斯变换;
因为存在时延,建立如下的时延模型:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>U</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>U</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>V</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,T表示主端与从端之间的时延,均为常数;
2)设计前向通道波变量补偿项
加入补偿项后,前向通道的波变量如下:
<mrow>
<msub>
<mi>U</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>&Delta;U</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>U</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mfrac>
<mi>&lambda;</mi>
<mrow>
<mi>s</mi>
<mo>+</mo>
<mi>&lambda;</mi>
</mrow>
</mfrac>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,ΔUs(s)为前向通道波变量补偿量的拉普拉斯变换;
为了达到稳定的跟踪性能,补偿量如下所示:
<mrow>
<msub>
<mi>&Delta;U</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>V</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mfrac>
<mi>&lambda;</mi>
<mrow>
<mi>s</mi>
<mo>+</mo>
<mi>&lambda;</mi>
</mrow>
</mfrac>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mo>+</mo>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
<msub>
<mi>F</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mfrac>
<mi>s</mi>
<mrow>
<mi>B</mi>
<mi>s</mi>
<mo>+</mo>
<mi>K</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
3)设计反向通道波变量补偿项
对反向通道的波变量增加补偿项ΔVm(s),反向通道的波变量表示为:
Vm(s)=Vs(s)e-sT+ΔVm(s) (1-13)
其中,ΔVm(s)为反向通道波变量补偿量的拉普拉斯变换;
从端反馈到主端的控制力为:
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>m</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>b</mi>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
<msub>
<mi>V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
将(1-13)与(1-9)带入(1-14),得到:
<mrow>
<msub>
<mi>F</mi>
<mrow>
<mi>m</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>F</mi>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mo>+</mo>
<mi>b</mi>
<mo>&lsqb;</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mo>&rsqb;</mo>
<mo>-</mo>
<msqrt>
<mrow>
<mn>2</mn>
<mi>b</mi>
</mrow>
</msqrt>
<msub>
<mi>&Delta;V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
令:
<mrow>
<msub>
<mi>&Delta;V</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mfrac>
<mi>b</mi>
<mn>2</mn>
</mfrac>
</msqrt>
<mo>&lsqb;</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mover>
<mi>X</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mi>s</mi>
<mi>c</mi>
</mrow>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>T</mi>
</mrow>
</msup>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
则(1-15)中的就会被消掉,从而可以满足(1-5)的要求;
经过化简,得到:
ΔVm=Um-Use-sT (1-17)
4)设计能量整定器
为了对主端耗散的能量进行计算,设计一个非负能量储存器:
<mrow>
<msub>
<mi>E</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<munderover>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</munderover>
<msubsup>
<mi>u</mi>
<mi>m</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mi>&tau;</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msubsup>
<mi>v</mi>
<mi>s</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mi>&tau;</mi>
<mo>-</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mi>d</mi>
<mi>&tau;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
Es(t)表示能量存储量,um(τ)为主端前向波变量的时域信号,vs(τ)为从端反向波变量的时域信号;
反向通道的波变量补偿项Δvm(t)的计算方式如下:
<mrow>
<msub>
<mi>&Delta;v</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&gamma;</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<msub>
<mi>&delta;E</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
</msup>
<mo>)</mo>
</mrow>
<mo>*</mo>
<mo>&lsqb;</mo>
<msub>
<mi>u</mi>
<mi>m</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>u</mi>
<mi>s</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mi>T</mi>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,γ和δ都是正的调节参数,γ决定了补偿的快慢,δ决定了能量储存器的累积的快慢,*代表卷积运算;当能量储存器达到零时,中的项就会成为零,从而会阻断补偿项的计算,保证系统的稳定性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510793832.8A CN105353616B (zh) | 2015-11-17 | 2015-11-17 | 一种基于波变量的定时延遥操作控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510793832.8A CN105353616B (zh) | 2015-11-17 | 2015-11-17 | 一种基于波变量的定时延遥操作控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105353616A CN105353616A (zh) | 2016-02-24 |
CN105353616B true CN105353616B (zh) | 2017-11-28 |
Family
ID=55329605
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510793832.8A Active CN105353616B (zh) | 2015-11-17 | 2015-11-17 | 一种基于波变量的定时延遥操作控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105353616B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106019981A (zh) * | 2016-05-16 | 2016-10-12 | 西北工业大学 | 一种用于时延非对称双人遥操作系统的稳定控制方法 |
CN107422639B (zh) * | 2017-07-13 | 2020-07-14 | 西北工业大学 | 一种基于时间延迟估计的双边遥操作控制方法 |
CN107991879B (zh) * | 2017-12-21 | 2019-11-08 | 浙江大学 | 一种改进波变量的遥操作双边控制方法 |
CN108340369B (zh) * | 2018-01-17 | 2020-03-17 | 浙江大学 | 一种基于时延补偿的四通道遥操作双边控制方法 |
CN108303880B (zh) * | 2018-01-18 | 2020-11-06 | 西北工业大学 | 一种基于时延补偿的机器人遥操作预测控制方法 |
CN108469733B (zh) * | 2018-03-22 | 2020-01-14 | 浙江大学 | 一种改进波变量的四通道遥操作多边控制方法 |
CN109901396A (zh) * | 2019-03-22 | 2019-06-18 | 清华大学深圳研究生院 | 一种双边遥操作系统中的改进波变量方法 |
CN110850741A (zh) * | 2019-11-22 | 2020-02-28 | 北京邮电大学 | 一种基于波变量的时域无源双边遥操作控制方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5581666A (en) * | 1993-08-04 | 1996-12-03 | Anderson; Robert J. | Modular architecture for robotics and teleoperation |
CN101930216B (zh) * | 2010-08-27 | 2012-04-18 | 东南大学 | 基于主从参考模型的遥操作机器人自适应控制方法 |
CN101986219B (zh) * | 2010-08-27 | 2012-05-09 | 东南大学 | 基于虚实力融合的遥操作机器人力觉临场感实现方法 |
CN103862473A (zh) * | 2014-03-04 | 2014-06-18 | 南昌大学 | 基于从端本地数据的波变量位移跟踪控制方法 |
CN103831831B (zh) * | 2014-03-18 | 2016-07-06 | 西华大学 | 具有时变时延的非线性遥操作系统位置和力跟踪控制系统 |
CN104503229A (zh) * | 2014-11-24 | 2015-04-08 | 北京邮电大学 | 基于ls-svm时延预测的波积分双边遥操作控制方法 |
-
2015
- 2015-11-17 CN CN201510793832.8A patent/CN105353616B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105353616A (zh) | 2016-02-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105353616B (zh) | 一种基于波变量的定时延遥操作控制方法 | |
CN101930216B (zh) | 基于主从参考模型的遥操作机器人自适应控制方法 | |
CN106773668B (zh) | 一种用于变时延双边遥操作系统的稳定控制方法 | |
CN108205259B (zh) | 基于线性扩张状态观测器的复合控制系统及其设计方法 | |
US20170302388A1 (en) | Digital Pre-Distortion Calibration Coefficient Control Method and Apparatus | |
CN110620528B (zh) | 一种基于二阶超螺旋滑模的多通道直流电机系统控制方法 | |
CN107240921A (zh) | 基于积分自适应逆推的svc滑模控制方法 | |
CN103389650B (zh) | 四通道遥操作系统的双边未知死区自适应控制系统 | |
CN102780821B (zh) | 一种送受话端采样率偏差纠正方法和系统 | |
KR102470722B1 (ko) | 모터 시스템 | |
CN108340369A (zh) | 一种基于时延补偿的四通道遥操作双边控制方法 | |
CN105867118A (zh) | 一种改进的电机位置伺服系统的自适应鲁棒控制方法 | |
CN104600703A (zh) | 一种基于相位裕度补偿的并网逆变器谐波谐振抑制方法 | |
CN104865922A (zh) | 一种化工多变量过程的完全时滞补偿控制方法 | |
CN101877567B (zh) | 马达速度命令产生装置及方法 | |
CN103631281B (zh) | 一种液压马达角速度伺服系统 | |
CN104505847B (zh) | 一种基于滑模控制的微网下垂控制优化方法 | |
CN107991879A (zh) | 一种改进波变量的遥操作双边控制方法 | |
CN117193146A (zh) | 智能体集群的控制方法及相关产品 | |
CN103192044A (zh) | 一种拉坯辊的传动负荷控制方法和装置 | |
CN106019981A (zh) | 一种用于时延非对称双人遥操作系统的稳定控制方法 | |
EP4184874A3 (en) | Method and system for interaction between vehicle and smart device | |
CN115808876A (zh) | 发动机尾喷管执行机构自适应控制方法及装置 | |
CN104216285A (zh) | 基于多模型的非线性系统的自适应混合控制方法及系统 | |
CN115616953A (zh) | 一种基于反步的远程伺服电机跟踪控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |