CN104166347A - 一种欠驱动机械臂系统的pd平衡控制方法 - Google Patents
一种欠驱动机械臂系统的pd平衡控制方法 Download PDFInfo
- Publication number
- CN104166347A CN104166347A CN201410385207.5A CN201410385207A CN104166347A CN 104166347 A CN104166347 A CN 104166347A CN 201410385207 A CN201410385207 A CN 201410385207A CN 104166347 A CN104166347 A CN 104166347A
- Authority
- CN
- China
- Prior art keywords
- actuating arm
- arm
- virtual
- output angle
- modeling
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000004913 activation Effects 0.000 claims description 54
- 238000004519 manufacturing process Methods 0.000 claims description 4
- 238000013341 scale-up Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 230000007246 mechanism Effects 0.000 claims description 2
- 230000004044 response Effects 0.000 abstract description 5
- 230000010354 integration Effects 0.000 abstract 1
- 230000008901 benefit Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000009897 systematic effect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提供一种欠驱动机械臂系统的PD平衡控制方法,包括:欠驱动机械臂系统的控制器发出电压信号,启动直流电机,直流电机输出转矩信号控制主驱动臂和欠驱动臂从垂直向下的初始位置摆起至目标平衡位置;用主驱动臂的编码器和欠驱动臂的编码器分别实时检测主驱动臂的输出角度和欠驱动臂的输出角度,判断主驱动臂和欠驱动臂是否偏离目标平衡位置,是,则对欠驱动机械臂系统进行PD平衡控制,控制主驱动臂和欠驱动臂保持在目标平衡位置;否则保持当前直流电机的输出转矩,使主驱动臂和欠驱动臂保持在目标平衡位置。本发明通过控制器进行控制信号与反馈信号的综合,实现欠驱动机械臂的控制,加快响应速度,扩大抗干扰空间,提高摆臂的稳态精度。
Description
技术领域
本发明属于自动控制领域,具体涉及一种欠驱动机械臂系统的PD平衡控制方法。
背景技术
欠驱动机械系统广泛存在于空间机器人、飞行器和潜水艇等领域,是一种典型的非完整系统。由于欠驱动臂不能直接控制,一般的光滑反馈控制方法对此类系统无效,这一类系统主要依靠关节间的耦合作用,实现欠驱动臂的控制,因此一般的解耦控制方法对这一系统也是无效的,这使得欠驱动系统的控制成为难点。大量的智能控制算法不断涌现,但其距实际的工业应用仍存在一定的差距。
PD控制是工业生产中应用最为广泛的控制器,它具有算法简单、鲁棒性好等优点,对于可建立精确数学模型的确定性系统的控制是非常有效的,但对于非线性的不确定系统往往难以得到较好的控制性能。在实际工业应用中,通常存在着各种不确定因素的影响,为了利用PD控制的优点,一般需要设计补偿器来改善系统的性能,但以往的估计方法没有充分利用系统的输入输出数据,造成数据浪费。
发明内容
针对现有技术存在的问题,本发明提供一种欠驱动机械臂系统的PD平衡控制方法。
本发明的技术方案是:
一种欠驱动机械臂系统的PD平衡控制方法,包括以下步骤:
步骤1:欠驱动机械臂系统的控制器发出电压信号,启动直流电机,直流电机输出转矩信号控制主驱动臂和欠驱动臂从垂直向下的初始位置摆起至目标平衡位置;
步骤2:用主驱动臂的编码器和欠驱动臂的编码器分别实时检测主驱动臂的输出角度和欠驱动臂的输出角度,判断主驱动臂和欠驱动臂是否偏离目标平衡位置,是,则执行步骤3;否则保持当前直流电机的输出转矩,使主驱动臂和欠驱动臂保持在目标平衡位置;
步骤3:对欠驱动机械臂系统进行PD平衡控制,控制主驱动臂和欠驱动臂保持在目标平衡位置;
步骤3.1:根据欠驱动机械臂系统的动力学模型,分别针对直流电机的转矩信号和主驱动臂的输出角度、直流电机的转矩信号和欠驱动臂的输出角度,建立并联的主驱动臂线性模型和欠驱动臂线性模型,求得主驱动臂线性模型的输出角度和欠驱动臂线性模型的输出角度:
其中:i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;是线性模型的输出角度;qi(k+1)是编码器检测到的输出角度;u(k)为直流电机的转矩信号;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数,z-1是后移算子,Ai(z-1)=1+ai1z-1+ai2z-2,Bi(z-1)=bi0+bi1z-1,ai1,ai2,bi0,bi1是未知参数;
步骤3.2:将主驱动臂的编码器检测到的主驱动臂的输出角度与主驱动臂线性模型的输出角度的差值作为主驱动臂的虚拟未建模动态,欠驱动臂的编码器检测到的欠驱动臂的输出角度与欠驱动臂线性模型的输出角度的差值作为欠驱动臂的虚拟未建模动态:
步骤3.3:根据主驱动臂线性模型、欠驱动臂线性模型、直流电机的转矩信号、主驱动臂的虚拟未建模动态和欠驱动臂的虚拟未建模动态建立欠驱动机械臂系统的离散数学模型:
Ai(z-1)qi(k+1)=Bi(z-1)u(k)+vi[x(k)]
其中,qi(k+1)是编码器检测到的输出角度;vi[x(k)]是虚拟未建模动态;u(k)为直流电机的转矩信号;i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数;通过对欠驱动机械臂系统的机理模型进行线性化处理得到或者通过工业过程中PID参数的经验值反向求解得到。
步骤3.4:建立虚拟未建模动态补偿的PD控制模型:
Hi(z-1)ui(k)=Ri(z-1)wi(k)-Gi(z-1)qi(k)-Ki(z-1)vi[x(k-1)]
式中:Hi(z-1),Ri(z-1),Gi(z-1),Ki(z-1)为虚拟未建模动态补偿的PD控制模型参数,Hi(z-1)=(1+hiz-1),hi是待定系数;Ri(z-1)=Gi(z-1)=gi0+gi1z-1,gi0=Kpi+Kdi,gi1=-Kdi,Kpi和Kdi是比例系数和微分系数;ui(k)为虚拟未建模动态补偿的PD控制模型的输出,即直流电机的转矩信号;wi(k)是当前k时刻的目标平衡位置;qi(k)是当前k时刻的输出角度;vi[x(k-1)]为k-1时刻的虚拟未建模动态;
步骤3.5:根据主驱动臂的编码器检测的主驱动臂的输出角度信号和欠驱动臂的编码器检测的欠驱动臂的输出角度信号、直流电机的转矩信号求解k-1时刻的虚拟未建模动态:
式中: 是k时刻线性模型的输出角度;
步骤3.6:将虚拟未建模动态补偿的PD控制模型代入欠驱动机械臂系统的离散数学模型,得到欠驱动机械臂系统的闭环方程:
[Ai(z-1)Hi(z-1)+z-1Bi(z-1)Gi(z-1)]qi(k+1)=Bi(z-1)Gi(z-1)wi(k)+[Hi(z-1)-Bi(z-1)Ki(z-1)]vi[x(k-1)]+Hi(z-1)Δvi[x(k)]
式中:Δvi[x(k)]=vi[x(k)]-vi[x(k-1)],vi[x(k)]为当前k时刻的虚拟未建模动态;
步骤3.7:采用闭环极点配置方法确定虚拟未建模动态补偿的PD控制模型参数Hi(z-1)、Ri(z-1)和Gi(z-1);
步骤3.8:令Hi(z-1)-Bi(z-1)Ki(z-1)=0,使得Ki(1)=Hi(1)/Bi(1),确定虚拟未建模动态补偿的PD控制模型参数Ki(z-1);
步骤3.9:根据建立的虚拟未建模动态补偿的PD控制模型得到虚拟未建模动态补偿的PD控制模型的输出,进而得到直流电机的转矩信号u(k):
u(k)=αu1(k)+βu2(k)
式中:α和β是线性加权系数;
步骤3.10:根据得到的直流电机的转矩信号调整直流电机的输出转矩,将主驱动臂和欠驱动臂控制在目标平衡位置。
有益效果:
本发明是针对单输入两输出的欠驱动机械臂系统,提出了一种虚拟未建模动态补偿的PD平衡控制策略,旨在解决现有控制方法依赖于系统精确模型,并且难以应用于工业过程的缺陷。欠驱动机械臂系统的执行机构是直流电机,检测反馈任务一般由脉冲型光电编码器完成,通过控制器进行控制信号与反馈信号的综合,实现欠驱动机械臂的控制。本发明的方法对于欠驱动机械臂的平衡控制,能够加快系统的响应速度,扩大抗干扰空间,大幅度提高摆臂的稳态精度。
附图说明
图1为本发明具体实施方式的欠驱动机械臂系统的虚拟未建模动态补偿的PD控制模型控制策略框图;
图2为本发明具体实施方式的欠驱动机械臂Pendubot系统结构示意图;
图3为本发明具体实施方式的LQR对比实验的实验曲线;
图4为本发明具体实施方式的SDRE对比实验的实验曲线;
图5为本发明具体实施方式的PD平衡控制(UDCPD)的实验曲线;
图6为本发明具体实施方式的PD平衡控制(UDCPD)主驱动臂的误差曲线;
图7为本发明具体实施方式的PD平衡控制(UDCPD)欠驱动臂的误差曲线;
图8为本发明具体实施方式的欠驱动机械臂系统的PD平衡控制方法流程图;
图9为本发明具体实施方式的对欠驱动机械臂系统进行PD平衡控制流程图。
具体实施方式
为了使本发明的技术方案和优点更加明晰,下面结合附图和实施方式,对本发明作进一步详细说明,本实施方式仅用于解释本发明,但并不限定本发明。
本实施方式中,选用宁波东大自动化智能技术有限公司生产的Pendubot倒立摆机器人实验系统实施欠驱动机械臂系统的PD平衡控制方法,采用网络化控制器和EasyControl软件进行控制方法的实现,该软件与Matlab/Simulink无缝连接,通过硬件驱动接口直接进行方法验证。实施欠驱动机械臂系统的PD平衡控制方法所采用的控制系统主要包括PC机、网络化控制器、直流电机和2个VLT12型高精度光电编码器。
图2为欠驱动机械臂Pendubot系统的结构示意图,该系统由主驱动臂、欠驱动臂和直流电机组成,为l1主动臂的长度,lc1为主动臂相对于连接点到质心的距离,lc2为欠驱动臂相对于连接点到质心的距离,q1表示主驱动臂的输出角度,q2表示欠驱动臂的输出角度。
本实施方式的欠驱动机械臂系统的PD平衡控制方法,如图8所示,包括以下步骤:
步骤1:欠驱动机械臂系统的控制器发出电压信号,启动直流电机,直流电机输出转矩信号控制主驱动臂和欠驱动臂从垂直向下的初始位置摆起至目标平衡位置;
步骤2:用主驱动臂的编码器和欠驱动臂的编码器分别实时检测主驱动臂的输出角度和欠驱动臂的输出角度,判断主驱动臂和欠驱动臂是否偏离目标平衡位置,是,则执行步骤3;否则保持当前直流电机的输出转矩,使主驱动臂和欠驱动臂保持在目标平衡位置;
步骤3:对欠驱动机械臂系统进行PD平衡控制,控制主驱动臂和欠驱动臂保持在目标平衡位置,如图9所示;
步骤3.1:根据欠驱动机械臂系统的动力学模型,分别针对直流电机的转矩信号和主驱动臂的输出角度、直流电机的转矩信号和欠驱动臂的输出角度,建立并联的主驱动臂线性模型和欠驱动臂线性模型,求得主驱动臂线性模型的输出角度和欠驱动臂线性模型的输出角度:
其中:i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;是线性模型的输出角度;qi(k+1)是编码器检测到的输出角度;u(k)为直流电机的转矩信号;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数,z-1是后移算子,Ai(z-1)=1+ai1z-1+ai2z-2,Bi(z-1)=bi0+bi1z-1,ai1,ai2,bi0,bi1是未知参数;
选取采样周期T0=2ms,将欠驱动机械臂系统动力学特性线性化,求得欠驱动机械臂系统动力学特性的参数:A1(z-1)=1-1.955z-1+0.999z-2,B1(z-1)=4.4057×10-4(1+z-1),A2(z-1)=1-1.955z-1+0.999z-2,B2(z-1)=-4.4057×10-4(1+z-1)
得到主驱动臂线性模型的输出角度和欠驱动臂线性模型的输出角度:
式中:q1(k)和q2(k)分别为k时刻主驱动臂的输出角度和欠驱动臂的输出角度;q1(k-1)和q2(k-1)分别为k-1时刻主驱动臂的输出角度和欠驱动臂的输出角度;u(k)为k时刻的直流电机的转矩信号,是未知的;u(k)为k-1时刻的直流电机的转矩信号;
步骤3.2:将主驱动臂的编码器检测到的主驱动臂的输出角度与主驱动臂线性模型的输出角度的差值作为主驱动臂的虚拟未建模动态,欠驱动臂的编码器检测到的欠驱动臂的输出角度与欠驱动臂线性模型的输出角度的差值作为欠驱动臂的虚拟未建模动态:
其中:qi(k+1)是编码器检测到的输出角度;为线性模型的输出角度;i=1,2;i=1表示主驱动臂,i=2表示欠驱动臂;
步骤3.3:根据主驱动臂线性模型、欠驱动臂线性模型、直流电机的转矩信号、主驱动臂的虚拟未建模动态和欠驱动臂的虚拟未建模动态建立欠驱动机械臂系统的离散数学模型:
Ai(z-1)qi(k+1)=Bi(z-1)u(k)+vi[x(k)]
其中,qi(k+1)是编码器检测到的输出角度;vi[x(k)]是虚拟未建模动态;u(k)为直流电机的转矩信号;i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数;
步骤3.4:建立虚拟未建模动态补偿的PD控制模型:
Hi(z-1)ui(k)=Ri(z-1)wi(k)-Gi(z-1)qi(k)-Ki(z-1)vi[x(k-1)]
式中:Hi(z-1),Ri(z-1),Gi(z-1),Ki(z-1)为虚拟未建模动态补偿的PD控制模型参数,Hi(z-1)=(1+hiz-1),hi是待定系数;Ri(z-1)=Gi(z-1)=gi0+gi1z-1,gi0=Kpi+Kdi,gi1=-Kdi,Kpi和Kdi是比例系数和微分系数;ui(k)为虚拟未建模动态补偿的PD控制模型的输出,即直流电机的转矩信号;wi(k)是当前k时刻的目标平衡位置;qi(k)是当前k时刻的输出角度;vi[x(k-1)]为k-1时刻的虚拟未建模动态;
步骤3.5:根据主驱动臂的编码器检测的主驱动臂的输出角度信号和欠驱动臂的编码器检测的欠驱动臂的输出角度信号、直流电机的转矩信号求解k-1时刻的虚拟未建模动态:
式中: 是k时刻线性模型的输出角度;
步骤3.6:将虚拟未建模动态补偿的PD控制模型代入欠驱动机械臂系统的离散数学模型,得到欠驱动机械臂系统的闭环方程:
[Ai(z-1)Hi(z-1)+z-1Bi(z-1)Gi(z-1)]qi(k+1)=Bi(z-1)Gi(z-1)wi(k)+[Hi(z-1)-Bi(z-1)Ki(z-1)]vi[x(k-1)]+Hi(z-1)Δvi[x(k)]
式中:Δvi[x(k)]=vi[x(k)]-vi[x(k-1)],vi[x(k)]为当前k时刻的虚拟未建模动态;
步骤3.7:采用闭环极点配置方法确定虚拟未建模动态补偿的PD控制模型参数Hi(z-1)、Ri(z-1)和Gi(z-1);
H1(z-1)=1+0.0349z-1,R1(z-1)=90.4825-86.2491z-1,G1(z-1)=90.4825-86.2491z-1
H2(z-1)=1+0.0349z-1,R2(z-1)=-90.4825+86.2491z-1,G2(z-1)=-90.4825+86.2491z-1
根据虚拟未建模动态补偿的PD控制模型参数得到图1中的比例系数和微分系数分别为:
Kp1=4.2334,Kd1=86.2491,Kp2=-4.2334,Kd1=-86.2491
步骤3.8:令Hi(z-1)-Bi(z-1)Ki(z-1)=0,使得Ki(1)=Hi(1)/Bi(1),确定虚拟未建模动态补偿的PD控制模型参数Ki(z-1);
确定图1中虚拟未建模动态补偿的PD控制模型参数Ki(z-1):
K1(z-1)=1275.4,K2(z-1)=-1275.4
步骤3.9:根据建立的虚拟未建模动态补偿的PD控制模型得到虚拟未建模动态补偿的PD控制模型的输出,进而得到直流电机的转矩信号u(k):
u(k)=αu1(k)+βu2(k)
式中:α和β是线性加权系数;
α=1,β=1,
其中,w1(k)和w1(k-1)分别为主驱动臂k时刻的目标平衡位置和k-1时刻的目标平衡位置,均为90度;q1(k)和q1(k-1)是由编码器测得的主驱动臂k时刻的输出角度和k-1时刻的输出角度;w2(k)和w2(k-1)分别为欠驱动臂k时刻的目标平衡位置和k-1时刻的目标平衡位置,均为0度;q2(k)和q2(k-1)是由编码器测得的欠驱动臂k时刻的输出角度和k-1时刻的输出角度;v1[x(k-1)]和v2[x(k-1)]是k-1时刻的两个虚拟未建模动态;
步骤3.10:根据得到的直流电机的转矩信号调整直流电机的输出转矩,将主驱动臂和欠驱动臂控制在目标平衡位置。
记录欠驱动机械臂系统的PD平衡控制时主驱动臂和欠驱动臂的输出角度得到如图5所示的曲线。
为评估本发明的有效性,选取线性二次型调节器(LQR)和基于状态的Riccati方程(SDRE)作为对比方法,与本实施方式的欠驱动机械臂系统的PD平衡控制方法(UDCPD)进行了比较。LQR控制方法的输出曲线如图3所示,SDRE控制方法的输出曲线如图4所示。
表1欠驱动机械臂系统的抗干扰空间
表2欠驱动机械臂系统的响应时间和稳态误差
表1和表2给出了LQR、SDRE和UDCPD方法分别作用于欠驱动机械臂Pendubot系统时,主驱动臂和欠驱动臂的抗干扰空间、响应速度和稳态误差的实验结果。三种控制方法的稳态误差曲线如图6和图7所示,分别给出了主驱动臂和欠驱动臂在目标平衡位置时的控制误差。结合图表可以看出,本实施方式的欠驱动机械臂的PD平衡控制方法,扩大了整个系统的抗干扰空间、减小了稳态时的误差,并且加快了系统的响应时间。
Claims (2)
1.一种欠驱动机械臂系统的PD平衡控制方法,其特征在于:包括以下步骤:
步骤1:欠驱动机械臂系统的控制器发出电压信号,启动直流电机,直流电机输出转矩信号控制主驱动臂和欠驱动臂从垂直向下的初始位置摆起至目标平衡位置;
步骤2:用主驱动臂的编码器和欠驱动臂的编码器分别实时检测主驱动臂的输出角度和欠驱动臂的输出角度,判断主驱动臂和欠驱动臂是否偏离目标平衡位置,是,则执行步骤3;否则保持当前直流电机的输出转矩,使主驱动臂和欠驱动臂保持在目标平衡位置;
步骤3:对欠驱动机械臂系统进行PD平衡控制,控制主驱动臂和欠驱动臂保持在目标平衡位置;
步骤3.1:根据欠驱动机械臂系统的动力学模型,分别针对直流电机的转矩信号和主驱动臂的输出角度、直流电机的转矩信号和欠驱动臂的输出角度,建立并联的主驱动臂线性模型和欠驱动臂线性模型,求得主驱动臂线性模型的输出角度和欠驱动臂线性模型的输出角度:
其中:i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;是线性模型的输出角度;qi(k+1)是编码器检测到的输出角度;u(k)为直流电机的转矩信号;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数,z-1是后移算子,Ai(z-1)=1+ai1z-1+ai2z-2,Bi(z-1)=bi0+bi1z-1,ai1,ai2,bi0,bi1是未知参数;
步骤3.2:将主驱动臂的编码器检测到的主驱动臂的输出角度与主驱动臂线性模型的输出角度的差值作为主驱动臂的虚拟未建模动态,欠驱动臂的编码器检测到的欠驱动臂的输出角度与欠驱动臂线性模型的输出角度的差值作为欠驱动臂的虚拟未建模动态:
步骤3.3:根据主驱动臂线性模型、欠驱动臂线性模型、直流电机的转矩信号、主驱动臂的虚拟未建模动态和欠驱动臂的虚拟未建模动态建立欠驱动机械臂系统的离散数学模型:
Ai(z-1)qi(k+1)=Bi(z-1)u(k)+vi[x(k)]
其中,qi(k+1)是编码器检测到的输出角度;vi[x(k)]是虚拟未建模动态;u(k)为直流电机的转矩信号;i=1,2,i=1表示主驱动臂,i=2表示欠驱动臂;Ai(z-1)、Bi(z-1)为表征欠驱动机械臂系统动力学特性的参数;
步骤3.4:建立虚拟未建模动态补偿的PD控制模型:
Hi(z-1)ui(k)=Ri(z-1)wi(k)-Gi(z-1)qi(k)-Ki(z-1)vi[x(k-1)]
式中:Hi(z-1),Ri(z-1),Gi(z-1),Ki(z-1)为虚拟未建模动态补偿的PD控制模型参数,Hi(z-1)=(1+hiz-1),hi是待定系数;Ri(z-1)=Gi(z-1)=gi0+gi1z-1,gi0=Kpi+Kdi,gi1=-Kdi,Kpi和Kdi是比例系数和微分系数;ui(k)为虚拟未建模动态补偿的PD控制模型的输出,即直流电机的转矩信号;wi(k)是当前k时刻的目标平衡位置;qi(k)是当前k时刻的输出角度;vi[x(k-1)]为k-1时刻的虚拟未建模动态;
步骤3.5:根据主驱动臂的编码器检测的主驱动臂的输出角度信号和欠驱动臂的编码器检测的欠驱动臂的输出角度信号、直流电机的转矩信号求解k-1时刻的虚拟未建模动态:
式中: 是k时刻线性模型的输出角度;
步骤3.6:将虚拟未建模动态补偿的PD控制模型代入欠驱动机械臂系统的离散数学模型,得到欠驱动机械臂系统的闭环方程:
[Ai(z-1)Hi(z-1)+z-1Bi(z-1)Gi(z-1)]qi(k+1)=Bi(z-1)Gi(z-1)wi(k)+[Hi(z-1)-Bi(z-1)Ki(z-1)]vi[x(k-1)]+Hi(z-1)Δvi[x(k)]
式中:Δvi[x(k)]=vi[x(k)]-vi[x(k-1)],vi[x(k)]为当前k时刻的虚拟未建模动态;
步骤3.7:采用闭环极点配置方法确定虚拟未建模动态补偿的PD控制模型参数Hi(z-1)、Ri(z-1)和Gi(z-1);
步骤3.8:令Hi(z-1)-Bi(z-1)Ki(z-1)=0,使得Ki(1)=Hi(1)/Bi(1),确定虚拟未建模动态补偿的PD控制模型参数Ki(z-1);
步骤3.9:根据建立的虚拟未建模动态补偿的PD控制模型得到虚拟未建模动态补偿的PD控制模型的输出,进而得到直流电机的转矩信号u(k):
u(k)=αu1(k)+βu2(k)
式中:α和β是线性加权系数;
步骤3.10:根据得到的直流电机的转矩信号调整直流电机的输出转矩,将主驱动臂和欠驱动臂控制在目标平衡位置。
2.根据权利要求1所述的欠驱动机械臂系统的PD平衡控制方法,其特征在于:步骤3.3所述的欠驱动机械臂系统的离散数学模型中的表征欠驱动机械臂系统动力学特性的参数Ai(z-1)、Bi(z-1)通过对欠驱动机械臂系统的机理模型进行线性化处理得到或者通过工业过程中PID参数的经验值反向求解得到。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410385207.5A CN104166347B (zh) | 2014-08-06 | 2014-08-06 | 一种欠驱动机械臂系统的pd平衡控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410385207.5A CN104166347B (zh) | 2014-08-06 | 2014-08-06 | 一种欠驱动机械臂系统的pd平衡控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104166347A true CN104166347A (zh) | 2014-11-26 |
CN104166347B CN104166347B (zh) | 2017-04-12 |
Family
ID=51910210
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410385207.5A Expired - Fee Related CN104166347B (zh) | 2014-08-06 | 2014-08-06 | 一种欠驱动机械臂系统的pd平衡控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104166347B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105022272A (zh) * | 2015-07-23 | 2015-11-04 | 北京航空航天大学 | 一种弹性体飞行器的鲁棒解耦控制方法 |
CN106239491A (zh) * | 2016-08-30 | 2016-12-21 | 江苏华航威泰机器人科技有限公司 | 一种倒立摆机器人驱动执行机构 |
CN107450579A (zh) * | 2017-07-27 | 2017-12-08 | 东南大学 | 一种搭载机械臂的四旋翼飞行器平衡作业控制方法 |
CN111352393A (zh) * | 2018-11-02 | 2020-06-30 | 北部湾大学 | 板形工件包边系统软件上料返程流程 |
CN111352446A (zh) * | 2018-11-02 | 2020-06-30 | 北部湾大学 | 板形工件包边装置的上料臂摆臂控制系统 |
CN113093780A (zh) * | 2021-04-06 | 2021-07-09 | 中山大学 | 一种基于降阶极点配置法的机器人平衡控制方法及装置 |
CN114290367A (zh) * | 2021-12-28 | 2022-04-08 | 中国地质大学(武汉) | 一种多欠驱动关节垂直机械臂系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1949107A (zh) * | 2006-11-09 | 2007-04-18 | 上海交通大学 | 线性多变量工业过程的全局最优控制器整定方法 |
CN101989080A (zh) * | 2010-12-03 | 2011-03-23 | 沈阳工业大学 | 用变增益零相位误差跟踪和扰动观测实现轮廓加工的方法 |
KR20110075854A (ko) * | 2009-12-29 | 2011-07-06 | 충남대학교산학협력단 | 탑승형 역진자 이동 로봇 시스템 |
US20110190935A1 (en) * | 2006-11-02 | 2011-08-04 | Hutcheson Timothy L | Reconfigurable balancing robot and method for moving over large obstacles |
CN103395065A (zh) * | 2013-08-07 | 2013-11-20 | 长春工业大学 | 基于双参数奇异摄动的液压刚柔机械臂控制方法 |
-
2014
- 2014-08-06 CN CN201410385207.5A patent/CN104166347B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110190935A1 (en) * | 2006-11-02 | 2011-08-04 | Hutcheson Timothy L | Reconfigurable balancing robot and method for moving over large obstacles |
CN1949107A (zh) * | 2006-11-09 | 2007-04-18 | 上海交通大学 | 线性多变量工业过程的全局最优控制器整定方法 |
KR20110075854A (ko) * | 2009-12-29 | 2011-07-06 | 충남대학교산학협력단 | 탑승형 역진자 이동 로봇 시스템 |
CN101989080A (zh) * | 2010-12-03 | 2011-03-23 | 沈阳工业大学 | 用变增益零相位误差跟踪和扰动观测实现轮廓加工的方法 |
CN103395065A (zh) * | 2013-08-07 | 2013-11-20 | 长春工业大学 | 基于双参数奇异摄动的液压刚柔机械臂控制方法 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105022272A (zh) * | 2015-07-23 | 2015-11-04 | 北京航空航天大学 | 一种弹性体飞行器的鲁棒解耦控制方法 |
CN106239491A (zh) * | 2016-08-30 | 2016-12-21 | 江苏华航威泰机器人科技有限公司 | 一种倒立摆机器人驱动执行机构 |
CN107450579A (zh) * | 2017-07-27 | 2017-12-08 | 东南大学 | 一种搭载机械臂的四旋翼飞行器平衡作业控制方法 |
CN107450579B (zh) * | 2017-07-27 | 2020-02-18 | 东南大学 | 一种搭载机械臂的四旋翼飞行器平衡作业控制方法 |
CN111352393A (zh) * | 2018-11-02 | 2020-06-30 | 北部湾大学 | 板形工件包边系统软件上料返程流程 |
CN111352446A (zh) * | 2018-11-02 | 2020-06-30 | 北部湾大学 | 板形工件包边装置的上料臂摆臂控制系统 |
CN111352446B (zh) * | 2018-11-02 | 2021-11-09 | 北部湾大学 | 板形工件包边装置的上料臂摆臂控制系统 |
CN113093780A (zh) * | 2021-04-06 | 2021-07-09 | 中山大学 | 一种基于降阶极点配置法的机器人平衡控制方法及装置 |
CN114290367A (zh) * | 2021-12-28 | 2022-04-08 | 中国地质大学(武汉) | 一种多欠驱动关节垂直机械臂系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104166347B (zh) | 2017-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104166347A (zh) | 一种欠驱动机械臂系统的pd平衡控制方法 | |
CN108356823B (zh) | 具有学习控制功能的控制系统以及控制方法 | |
CN108803324A (zh) | 多关节工业机械臂反步有限时间滑模控制方法 | |
CN108942924A (zh) | 基于多层神经网络的模型不确定性机械臂运动控制方法 | |
CN104238361B (zh) | 电机伺服系统自适应鲁棒位置控制方法与系统 | |
CN104111607B (zh) | 一种考虑输入时滞的电机位置伺服系统的控制方法 | |
CN103406909B (zh) | 一种机械臂系统的跟踪控制设备及方法 | |
KR101522511B1 (ko) | 제어 방법 및 제어 장치 | |
CN108303885A (zh) | 一种基于干扰观测器的电机位置伺服系统自适应控制方法 | |
CN104252134A (zh) | 基于扩张状态观测器的电机伺服系统自适应鲁棒位置控制方法 | |
CN106527126A (zh) | 电机伺服系统非线性鲁棒自适应位置控制器的实现方法 | |
CN103728988B (zh) | 基于内模的scara机器人轨迹跟踪控制方法 | |
CN111752262B (zh) | 一种执行器故障观测器与容错控制器集成设计方法 | |
CN107193211A (zh) | 基于自抗扰和反演技术的单臂机械手控制器及其设计方法 | |
CN104460704A (zh) | 一种基于扰动上界估计的电动转台俯仰位置跟踪控制方法 | |
CN114800519B (zh) | 一种考虑摩擦的六自由度工业机器人动力学参数辨识方法 | |
CN104597753B (zh) | 一种同步碎石封层车沥青碎石撒布智能控制方法及装置 | |
Li et al. | Extended State Observer Based Adaptive Back‐Stepping Sliding Mode Control of Electronic Throttle in Transportation Cyber‐Physical Systems | |
CN105759616A (zh) | 考虑死区特性的伺服系统有限时间控制方法 | |
CN101887260A (zh) | 一种自适应同步策略的工业过程最优控制系统及方法 | |
CN107957683B (zh) | 一种具有输入约束的网络化倒立摆系统的时延补偿方法 | |
CN109597316B (zh) | 一种基于阶跃响应特征的闭环辨识模型结构确定方法 | |
JP2014117787A (ja) | 制御装置 | |
CN107102555A (zh) | 一种镇定一阶惯性加纯滞后系统的线性自抗扰控制器设计方法 | |
Nilkhamhang et al. | Model-based adaptive friction compensation for accurate position control |
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 | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20141126 Assignee: ZHEJIANG DAFENG TECHNOLOGY Co.,Ltd. Assignor: Northeastern University Contract record no.: 2018210000035 Denomination of invention: PD balance control method of underactuation mechanical arm system Granted publication date: 20170412 License type: Common License Record date: 20181229 |
|
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: 20170412 |