CN106054598A - 机器人自适应转向单神经元pid控制方法 - Google Patents
机器人自适应转向单神经元pid控制方法 Download PDFInfo
- Publication number
- CN106054598A CN106054598A CN201610297395.5A CN201610297395A CN106054598A CN 106054598 A CN106054598 A CN 106054598A CN 201610297395 A CN201610297395 A CN 201610297395A CN 106054598 A CN106054598 A CN 106054598A
- Authority
- CN
- China
- Prior art keywords
- steering
- formula
- arm
- motor
- 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.)
- Pending
Links
- 210000002569 neuron Anatomy 0.000 title claims abstract description 34
- 238000000034 method Methods 0.000 title claims abstract description 12
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 6
- 238000013528 artificial neural network Methods 0.000 claims abstract description 7
- 230000006870 function Effects 0.000 claims description 26
- 230000001537 neural effect Effects 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 6
- 238000013461 design Methods 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 5
- 230000010354 integration Effects 0.000 claims description 5
- 230000033001 locomotion Effects 0.000 claims description 5
- 230000007935 neutral effect Effects 0.000 claims description 5
- 238000013519 translation Methods 0.000 claims description 5
- 101150096839 Fcmr gene Proteins 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims description 3
- 230000005284 excitation Effects 0.000 claims description 3
- 230000004907 flux Effects 0.000 claims description 3
- 238000012886 linear function Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 230000006386 memory function Effects 0.000 claims description 3
- 239000000203 mixture Substances 0.000 claims description 3
- 230000008054 signal transmission Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 210000004027 cell Anatomy 0.000 claims 1
- 230000007423 decrease Effects 0.000 claims 1
- 230000008901 benefit Effects 0.000 abstract description 4
- 238000013178 mathematical model Methods 0.000 abstract description 2
- 238000005070 sampling Methods 0.000 description 7
- 230000004044 response Effects 0.000 description 5
- 241000176964 Mononeuron Species 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 206010033799 Paralysis Diseases 0.000 description 2
- 230000001276 controlling effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000009514 concussion Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- JEIPFZHSYJVQDO-UHFFFAOYSA-N ferric oxide Chemical compound O=[Fe]O[Fe]=O JEIPFZHSYJVQDO-UHFFFAOYSA-N 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
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
- G05B13/042—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 in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种机器人自适应转向单神经元PID控制方法,首先建立机器人转向系统的转向模型,然后构建RBF神经网络,最后构建PID控制系统。本发明针对机器人转向系统的机械结构及数学模型的特点,设计了基于RBF在线辨识的机器人转向单神经元PID控制,将RBF神经网络与单神经元PID控制相结合应用于非线性的机器人转向系统,既充分利用了RBF神经网络最佳逼近性能的特点和单神经元适应性强的优点,也克服了PID控制中学习算法的不足。
Description
技术领域
本发明涉及机器人控制方法领域,具体是一种机器人自适应转向单神经元PID控制方法。
背景技术
物联网是“万物沟通”的、具有全面感知、可靠传送、智能处理特征的连接物理世界的网络,实现了任何时间、任何地点及任何物体的连结。但是,针对农田环境物联网监测区域中布置的传感器节点,会出现能量耗尽、数据处理能力弱和节点故障所引起的局部网络瘫痪问题,移动机器人可以作为一个移动传感节点,替代故障节点,解决局部网络瘫痪的问题。
由于农田环境复杂,遍布沟、渠和作物;地面松软,易使机器人滑移沉陷,需要机器人躲避,这就对机器人的运动控制提出了更高的要求。
自动转向控制技术是机器人实现自动导航控制的基础,也是研究机器人的核心问题之一。差速转向是机器人常用的转向方法,机器人的控制器大都采用PID控制器或最优控制器,常规的PID控制器为单偏差控制器,很难适应机器人这个复杂的转向系统,最优控制一般都把被控对象简化为线性时不变系统,这将降低机器人的稳定性。有些学者提出具有良好跟踪性和鲁棒性的变结构控制,但是存在需要通过实验确定加速度达到律中的参数和有待实验验证其可靠性的问题。
发明内容
本发明的目的是提供一种机器人自适应转向单神经元PID控制方法,以实现对机器人的自动转向控制。
为了达到上述目的,本发明所采用的技术方案为:
机器人自适应转向单神经元PID控制方法,所述机器人作为移动传感节点,机器人的前两轮为转向轮,后两轮为驱动轮,其特征在于:包括以下步骤:
(1)、建立机器人转向系统的转向模型:
构建电机转角与转向轮转角的比例系数为1、两相混合式步进电机作为转向器的转向系统,该转向系统包括同轴连接两转向轮的轮轴,轮轴上铰接有一对梯形臂,两梯形臂上端之间铰接有转向横拉杆,步进电机为两相混合步进电机,步 进电机与一个转向摇臂传动连接,转向摇臂臂端与一个转向直拉杆铰接,转向直拉杆杆端与一个转向节臂铰接,转向节臂臂端铰接在其中一个梯形臂与轮轴的铰接点;当外部转向控制器发出转向信号时,步进电机通过花键带动转向摇臂旋转,转向摇臂带动转向直拉杆作竖直方向的平动,再带动转向节臂做转动,转向节臂带动梯形臂和左轮转动,同时梯形臂带转动向横拉杆作横行平移,从而带动右侧的转向节臂转动,实现右轮的转向;
由于转向系统中转向器选用的是两相混合式步进电机,其传递函数如公式(1)所示:
G(S)=θ'/θi (1),
公式(1)中,θ'是步进电机的输出角度,θi代表步进电机的输入角度,经过微分方程推导得转子的运动方程如公式(2)所示:
公式(2)中,J是电机或变速机构折合到电机轴上的转动惯量,单位是kg.m;f是电机或变速机构折合到电机轴上的粘性摩擦系数,单位是kg.m.s/rad;是摩擦转矩;λ是极距角;φm是永磁体交链磁通;P是转子齿数;
在零初始条件下,当iA=iB=i0,对公式(2)进行拉普拉斯变换,可推导出相应的转向系统传递函数模型如公式(3)所示:
公式(3)中,I0是额定相电流;是无阻尼固有频率;ξ=f/(2Jωnp)是衰减系数;
(2)、构建RBF神经网络:
RBF神经元网络由输入层、隐含层、输出层三层网络构成,输入层到隐含层权值固定为1,负责信号的传递,隐含层由一组高斯基函数神经元构成,隐含层到输出层之间权值可调,而输出层的激励函数为线性函数,因此输出层是隐含层输 出的线性组合;RBF的隐单元按公式(4)输出:
公式(4)中,是输入矢量;hi(xk)是第i个隐单元的输出;ci=[ci1,ci2,...cim]是第i个隐单元高斯函数的中心矢量;b=[b1,b2,...,bm]是基宽向量;W=[w1,w2,...,wm]是隐含层到输出层的权向量;||xk-ci||表示向量xk和ci之间的距离,随着该向量距离的增大hi(xk)的值迅速减小,因此对每一个输入xk,只有中心靠近xk的少数几个隐含层神经元处于激活状态;
根据函数逼近原理,RBF网络的输出为隐层节点输出的线性组合,RBF神经网络的输出如公式(5)所示:
(3)、构建PID控制系统:
基于RBF在线辨识的单神经元PID控制系统主要由SNPID和RBFNNI两部分构成,利用神经网络的非线性函数逼近能力和学习记忆功能,由RBFNNI快速跟踪转向信息的变化,对被控对象信息进行辨识,SNPID利用RBFNNI提供的信息,实时调整PID控制器的参数,达到PID控制器参数的在线自整定,包括以下步骤:
(3.1)、设计RBF神经网络辨识器RBFNNI:
取x=[u(k),u(k-1),y(k-1)]为RBFNNI的输入向量,其中,u(k),y(k)分别为转向系统的控制值和反馈值,逼近误差em=y(k)-ym(k),性能指标函数选取为:
根据梯度下降的思想,采用迭代算法确定权节点、节点中心及节点基宽参数,其中学习速率η和动量因子α按照公式(8)实现实时更新:
RBFNNI通过对转向系统的在线辨识获取Jacobian辨识信息送往SNPID,以调整单神经元控制器的参数,Jacobian矩阵为,
(3.2)、设计单神经元PID控制器SNPID:
SNPID是将PID控制规律融入神经网络之中的新型控制器,隐含层中含有比例P、积分I、微分D三个单元,该控制器利用RBFNNI提供的Jacobian信息,在线调整PID控制器中kp,ki,kd三个参数,实现PID控制器参数的在线自整定;该控制器实质上为一变系数的比例、积分、微分控制器,学习算法是自适应的,所以本质上是非线性的;自适应性是通过单神经元加权系数wi(k)的调整实现,控制和学习算法如下:
设系统输入指令为rin(k),实际输出为y(k),系统的控制误差为e(k)=rin(k)-y(k)。单神经元的输入为:
离散控制为:
公式(11)中,K>0为单神经元的比例系数;wi(k)为单神经元网络的权系数,性能指标函数取为:
Jc=0.5[rin(k)-y(k)]2=0.5e2(k) (12),
加权系数的调整量为:
由于所以被控对象的Jacobian信息可以由取代,由此可得调整后的加权系数如公式(14)所示:
ηp,ηi,ηd,分别为比例、积分、微分的学习速率,对不同的权系数分别进行调整。
本发明提出利用具有最佳逼近性能的RBF神经网络对转向系统进行在线辨识,快速跟踪其信息的变化,在此基础上,单神经元PID控制器SNID(single neuron PIDcontroller)利用BFNNI(RBF neural network identifier)辨识器提供的辨识信息,实时调整PID控制器参数,结合专门的转向机械机构来实施机器人的自动转向,能够达到良好的自动转向控制效果。
本发明针对机器人转向系统的机械结构及数学模型的特点,设计了基于RBF在线辨识的机器人转向单神经元PID控制,将RBF神经网络与单神经元PID控制相结合应用于非线性的机器人转向系统,既充分利用了RBF神经网络最佳逼近性能的特点和单神经元适应性强的优点,也克服了PID控制中学习算法的不足。仿真及实验结果表明该控制器具有鲁棒性好,精度高的优点,具有重要的实用价值。
附图说明
图1为转向系统结构原理示意图。
图2为RBF神经网络结构图。
图3为基于RBF在线辨识的单神经元PID控制框图。
图4为偏差e的曲线图。
图5为偏差de的变化曲线图。
图6为kp,ki,kd随时间的变化曲线图。
图7为y=sin(2*pi*k*t)+cos(2*pi*k*t/2)的响应曲线图。
图8为基于PID和基于RBF在线辨识的单神经元PID控制机器人转向的误差曲线图。
具体实施方式
机器人自适应转向单神经元PID控制方法,机器人作为移动传感节点,机器人的前两轮为转向轮,后两轮为驱动轮,包括以下步骤:
(1)、建立机器人转向系统的转向模型:
构建电机转角与转向轮转角的比例系数为1、两相混合式步进电机6作为转向器的转向系统,如图1所示,该转向系统包括同轴连接两转向轮1的轮轴,轮轴上铰接有一对梯形臂2,两梯形臂2上端之间铰接有转向横拉杆7,步进电机6为两相混合步进电机,步进电机6与一个转向摇臂5传动连接,转向摇臂5臂端与一个转向直拉杆4铰接,转向直拉杆4杆端与一个转向节臂3铰接,转向节臂3臂端铰接在其中一个梯形臂与轮轴的铰接点;当外部转向控制器发出转向信号时,步进电机6通过花键带动转向摇臂5旋转,转向摇臂5带动转向直拉杆4作竖直方向的平动,再带动转向节臂3做转动,转向节臂3带动梯形臂2和左轮转动,同时梯形臂2带转动向横拉杆7作横行平移,从而带动右侧的转向节臂3转动,实现右轮的转向;
由于转向系统中转向器选用的是两相混合式步进电机,其传递函数如公式(1)所示:
G(S)=θ'/θi (1),
公式(1)中,θ'是步进电机的输出角度,θi代表步进电机的输入角度,经过微分方程推导得转子的运动方程如公式(2)所示:
公式(2)中,J是电机或变速机构折合到电机轴上的转动惯量,单位是kg.m;f是电机或变速机构折合到电机轴上的粘性摩擦系数,单位是kg.m.s/rad;是摩擦转矩;λ是极距角;φm是永磁体交链磁通;P是转子齿数;
在零初始条件下,当iA=iB=i0,对公式(2)进行拉普拉斯变换,可推导出相 应的转向系统传递函数模型如公式(3)所示:
公式(3)中,I0是额定相电流;是无阻尼固有频率;ξ=f/(2Jωnp)是衰减系数;
(2)、构建RBF神经网络:
如图2所示,RBF神经元网络由输入层、隐含层、输出层三层网络构成,输入层到隐含层权值固定为1,负责信号的传递,隐含层由一组高斯基函数神经元构成,隐含层到输出层之间权值可调,而输出层的激励函数为线性函数,因此输出层是隐含层输出的线性组合;RBF的隐单元按公式(4)输出:
公式(4)中,是输入矢量;hi(xk)是第i个隐单元的输出;ci=[ci1,ci2,...cim]是第i个隐单元高斯函数的中心矢量;b=[b1,b2,...,bm]是基宽向量;W=[w1,w2,...,wm]是隐含层到输出层的权向量;||xk-ci||表示向量xk和ci之间的距离,随着该向量距离的增大hi(xk)的值迅速减小,因此对每一个输入xk,只有中心靠近xk的少数几个隐含层神经元处于激活状态;
根据函数逼近原理,RBF网络的输出为隐层节点输出的线性组合,RBF神经网络的输出如公式(5)所示:
(3)、构建PID控制系统:
如图3所示,基于RBF在线辨识的单神经元PID控制系统主要由SNPID和RBFNNI两部分构成,利用神经网络的非线性函数逼近能力和学习记忆功能,由RBFNNI快速跟踪转向信息的变化,对被控对象信息进行辨识,SNPID利用RBFNNI提供的信息,实时调整PID控制器的参数,达到PID控制器参数的在线自整定,包括以下 步骤:
(3.1)、设计RBF神经网络辨识器RBFNNI:
取x=[u(k),u(k-1),y(k-1)]为RBFNNI的输入向量,其中,u(k),y(k)分别为转向系统的控制值和反馈值,逼近误差em=y(k)-ym(k),性能指标函数选取为:
根据梯度下降的思想,采用迭代算法确定权节点、节点中心及节点基宽参数,其中学习速率η和动量因子α按照公式(8)实现实时更新:
RBFNNI通过对转向系统的在线辨识获取Jacobian辨识信息送往SNPID,以调整单神经元控制器的参数,Jacobian矩阵为,
(3.2)、设计单神经元PID控制器SNPID:
SNPID是将PID控制规律融入神经网络之中的新型控制器,隐含层中含有比例P、积分I、微分D三个单元,该控制器利用RBFNNI提供的Jacobian信息,在线调整PID控制器中kp,ki,kd三个参数,实现PID控制器参数的在线自整定;该控制器实质上为一变系数的比例、积分、微分控制器,学习算法是自适应的,所以本质上是非线性的;自适应性是通过单神经元加权系数wi(k)的调整实现,控制和学习算法如下:
设系统输入指令为rin(k),实际输出为y(k),系统的控制误差为e(k)=rin(k)-y(k)。单神经元的输入为:
离散控制为:
公式(11)中,K>0为单神经元的比例系数;wi(k)为单神经元网络的权系数,性能指标函数取为:
Jc=0.5[rin(k)-y(k)]2=0.5e2(k) (12),
加权系数的调整量为:
由于所以被控对象的Jacobian信息可以由取代,由此可得调整后的加权系数如公式(14)所示:
ηp,ηi,ηd,分别为比例、积分、微分的学习速率,对不同的权系数分别进行调整。
转向系统仿真:
取机器人转向系统的参数如下:φm=3.38*10-4Wb,J=4.08*10-5Kg.m2,f=0.011Kg.m/rad/s,I0=1.6A,所以从公式(3)可知机器人转向系统的传递函数为:
采用Z变换对该传递函数离散化,取采样周期为0.001s,离散化后den=[1 -1.7059 0.76368],num=[0 0.030186 0.027578],得如下输出差分方程,
以xk=[u(k-1,y(k),y(k-1)]为RBFNNI的3个输入变量,y=sin(2*pi*k*t)+cos(2*pi*k*t/2)为控制系统的参考输入信号,RBF网络基函数半径取b=0.53,单神经元比例系数k=0.55,加权系数初值取w1=0.03,w2=0.01,w3=0.02,取控制器参数学习速率ηp=0.3,ηi=0.18,ηd=0.25,取采样时间为1ms,经过1000个采样周期后,仿真结果如图4~7所示。从这些仿真结果曲线可以看出:
(1)在图4、图5显示的系统输出偏差和偏差变化率曲线中,控制系统输出响应的前50个采样周期,偏差变化率ec逐渐增大,偏差e逐渐减小,表明系统的控制精度由于RBFNNI的准确辨识和SNPID参数的自适应调整而提高,控制系统的输出快速逼近参考曲线。
(2)从图6的PID控制参数自适应整定的曲线可知:在系统输出响应的前50个采样周期,由于偏差逐渐减小,比例增益kp从25降到22,以减小响应速度;在前500周期内,为了抑制超调,微分增益参数kd逐渐增大,500个采样周期后,由于偏差减小,偏差变化率保持稳定,kd略有减小;为了防止震荡,在前50个周期积分增益ki自适应的从0.7调整到0.9,50个周期后,由于偏差减小稳定在0的附近,ki保持较大的值0.9,以消除系统的稳态误差。
(3)图7显示基于RBF在线辨识的单神经元PID控制和常规PID控制分别对y=sin(2*pi*k*t)+cos(2*pi*k*t/2)的响应曲线,其中实线是参考曲线,虚线是基于RBF在线辨识的机器人转向单神经元PID控制的输出曲线,双划线是PID控制输出的曲线,在初始50个采样周期,由于RBFNNI刚刚开始辩识,SNPID初值参数的选择未必最为恰当,参数的调整未能很好的适应输入信号的变化,其控制效果与常规PID控制一样较差,经过50个采样周期后,RBFNNI能够较精确的辨识对象,获得精确的转向信息,SNPID的参数随着准确的辨识信息的输入而进行相应的调整,控制效果得以的改善,明显的优于PID控制。
转向系统实验验证:
为验证仿真实验结果,在自主研制的机器人上进行了实时控制试验。该转向系统由SEED–DEC-2812嵌入式控制模板控制,SEED-DEC-643高清晰图像处理平台为控制器提供转向信息。DEC2812输出PWM,通过驱动电路驱动转向轮,运动时编码盘产生的脉冲数和脉冲频率提供机器人的角度位置和转速。当机器人以8m/s的速度运行,以y=12*sin(2*pi*k*t)+cos(2*pi*k*t/2)为参考路径,分别以PID和基于RBF在线辨识的单神经元PID控制机器人转向,其误差曲线如图8,其中,虚线是PID控制的误差曲线,实线是基于RBF在线辨识的单神经元PID控制的误差曲线,采用后者控制的机器人转向,其误差范围在-0.0045~0.0052rad之间,而采用前者的误差范围为在-0.0094~0.0126rad之间,当机器人在[0,200],[400,700],[900,1000]ms这三个时间段内运行时,由于跟踪的路径较为平滑,这两种控制方法都有较好的跟踪效果,偏差较小,当机器人在[300,400]和[700,900]ms这两个时间段内运行时,跟踪的路径是两个转角,由于PID控制不能自适应的调整控制参数,因而产生较大的偏差,相反,基于RBF在线辨识的单神经元PID控制器具有自适应调整控制参数的能力,偏差就较小。试验结果表明基于RBF在线辨识的机器人转向单神经元PID控制具有更高的精度和稳定性。
Claims (1)
1.机器人自适应转向单神经元PID控制方法,所述机器人作为移动传感节点,机器人的前两轮为转向轮,后两轮为驱动轮,其特征在于:包括以下步骤:
(1)、建立机器人转向系统的转向模型:
构建电机转角与转向轮转角的比例系数为1、两相混合式步进电机作为转向器的转向系统,该转向系统包括同轴连接两转向轮的轮轴,轮轴上铰接有一对梯形臂,两梯形臂上端之间铰接有转向横拉杆,步进电机为两相混合步进电机,步进电机与一个转向摇臂传动连接,转向摇臂臂端与一个转向直拉杆铰接,转向直拉杆杆端与一个转向节臂铰接,转向节臂臂端铰接在其中一个梯形臂与轮轴的铰接点;当外部转向控制器发出转向信号时,步进电机通过花键带动转向摇臂旋转,转向摇臂带动转向直拉杆作竖直方向的平动,再带动转向节臂做转动,转向节臂带动梯形臂和左轮转动,同时梯形臂带转动向横拉杆作横行平移,从而带动右侧的转向节臂转动,实现右轮的转向;
由于转向系统中转向器选用的是两相混合式步进电机,其传递函数如公式(1)所示:
G(S)=θ'/θi (1),
公式(1)中,θ'是步进电机的输出角度,θi代表步进电机的输入角度,经过微分方程推导得转子的运动方程如公式(2)所示:
公式(2)中,J是电机或变速机构折合到电机轴上的转动惯量,单位是kg.m;f是电机或变速机构折合到电机轴上的粘性摩擦系数,单位是kg.m.s/rad;是摩擦转矩;λ是极距角;φm是永磁体交链磁通;P是转子齿数;
在零初始条件下,当iA=iB=i0,对公式(2)进行拉普拉斯变换,可推导出相应的转向系统传递函数模型如公式(3)所示:
公式(3)中,I0是额定相电流;是无阻尼固有频率;ξ=f/(2Jωnp)是衰减系数;
(2)、构建RBF神经网络:
RBF神经元网络由输入层、隐含层、输出层三层网络构成,输入层到隐含层权值固定为1,负责信号的传递,隐含层由一组高斯基函数神经元构成,隐含层到输出层之间权值可调,而输出层的激励函数为线性函数,因此输出层是隐含层输出的线性组合;RBF的隐单元按公式(4)输出:
公式(4)中,是输入矢量;hi(xk)是第i个隐单元的输出;ci=[ci1,ci2,...cim]是第i个隐单元高斯函数的中心矢量;b=[b1,b2,...,bm]是基宽向量;W=[w1,w2,...,wm]是隐含层到输出层的权向量;||xk-ci||表示向量xk和ci之间的距离,随着该向量距离的增大hi(xk)的值迅速减小,因此对每一个输入xk,只有中心靠近xk的少数几个隐含层神经元处于激活状态;
根据函数逼近原理,RBF网络的输出为隐层节点输出的线性组合,RBF神经网络的输出如公式(5)所示:
(3)、构建PID控制系统:
基于RBF在线辨识的单神经元PID控制系统主要由SNPID和RBFNNI两部分构成,利用神经网络的非线性函数逼近能力和学习记忆功能,由RBFNNI快速跟踪转向信息的变化,对被控对象信息进行辨识,SNPID利用RBFNNI提供的信息,实时调整PID控制器的参数,达到PID控制器参数的在线自整定,包括以下步骤:
(3.1)、设计RBF神经网络辨识器RBFNNI:
取x=[u(k),u(k-1),y(k-1)]为RBFNNI的输入向量,其中,u(k),y(k)分别为转向系统的控制值和反馈值,逼近误差em=y(k)-ym(k),性能指标函数选取为:
根据梯度下降的思想,采用迭代算法确定权节点、节点中心及节点基宽参数,其中学习速率η和动量因子α按照公式(8)实现实时更新:
RBFNNI通过对转向系统的在线辨识获取Jacobian辨识信息送往SNPID,以调整单神经元控制器的参数,Jacobian矩阵为,
(3.2)、设计单神经元PID控制器SNPID:
SNPID是将PID控制规律融入神经网络之中的新型控制器,隐含层中含有比例P、积分I、微分D三个单元,该控制器利用RBFNNI提供的Jacobian信息,在线调整PID控制器中kp,ki,kd三个参数,实现PID控制器参数的在线自整定;该控制器实质上为一变系数的比例、积分、微分控制器,学习算法是自适应的,所以本质上是非线性的;自适应性是通过单神经元加权系数wi(k)的调整实现,控制和学习算法如下:
设系统输入指令为rin(k),实际输出为y(k),系统的控制误差为e(k)=rin(k)-y(k)。单神经元的输入为:
离散控制为:
公式(11)中,K>0为单神经元的比例系数;wi(k)为单神经元网络的权系数,性能指标函数取为:
Jc=0.5[rin(k)-y(k)]2=0.5e2(k) (12),
加权系数的调整量为:
由于所以被控对象的Jacobian信息可以由取代,由此可得调整后的加权系数如公式(14)所示:
ηp,ηi,ηd,分别为比例、积分、微分的学习速率,对不同的权系数分别进行调整。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610297395.5A CN106054598A (zh) | 2016-05-05 | 2016-05-05 | 机器人自适应转向单神经元pid控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610297395.5A CN106054598A (zh) | 2016-05-05 | 2016-05-05 | 机器人自适应转向单神经元pid控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106054598A true CN106054598A (zh) | 2016-10-26 |
Family
ID=57176789
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610297395.5A Pending CN106054598A (zh) | 2016-05-05 | 2016-05-05 | 机器人自适应转向单神经元pid控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106054598A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107092256A (zh) * | 2017-05-27 | 2017-08-25 | 中国科学院自动化研究所 | 一种无人车转向控制方法 |
CN108227476A (zh) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | 一种agv小车的控制方法 |
CN108873705A (zh) * | 2018-07-19 | 2018-11-23 | 杭州电子科技大学 | 一种基于非线性pid的hh神经元同步控制方法 |
CN111103790A (zh) * | 2019-12-05 | 2020-05-05 | 珠海格力电器股份有限公司 | Pid控制器的参数整定方法、装置、存储介质、终端及系统 |
CN111290348A (zh) * | 2019-12-18 | 2020-06-16 | 浙江工业大学 | 一种可实现全向移动的多载agv控制系统及其控制方法 |
CN112590746A (zh) * | 2020-12-25 | 2021-04-02 | 南京晨光集团有限责任公司 | 一种基于伺服电动缸的无人配送小车刹车转向系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968629A (zh) * | 2010-10-19 | 2011-02-09 | 天津理工大学 | 基于rbf辨识的弹性积分bp神经网络的pid控制方法 |
CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
CN106033189A (zh) * | 2015-03-16 | 2016-10-19 | 徐州工程学院 | 飞行机器人位姿神经网络预测控制器 |
-
2016
- 2016-05-05 CN CN201610297395.5A patent/CN106054598A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101968629A (zh) * | 2010-10-19 | 2011-02-09 | 天津理工大学 | 基于rbf辨识的弹性积分bp神经网络的pid控制方法 |
CN106033189A (zh) * | 2015-03-16 | 2016-10-19 | 徐州工程学院 | 飞行机器人位姿神经网络预测控制器 |
CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
Non-Patent Citations (1)
Title |
---|
焦俊等: "《基于RBF在线辨识的AGV转向单神经元PID控制》", 《仪器仪表学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107092256A (zh) * | 2017-05-27 | 2017-08-25 | 中国科学院自动化研究所 | 一种无人车转向控制方法 |
CN107092256B (zh) * | 2017-05-27 | 2020-03-17 | 中国科学院自动化研究所 | 一种无人车转向控制方法 |
CN108227476A (zh) * | 2017-09-04 | 2018-06-29 | 河南森源电气股份有限公司 | 一种agv小车的控制方法 |
CN108873705A (zh) * | 2018-07-19 | 2018-11-23 | 杭州电子科技大学 | 一种基于非线性pid的hh神经元同步控制方法 |
CN111103790A (zh) * | 2019-12-05 | 2020-05-05 | 珠海格力电器股份有限公司 | Pid控制器的参数整定方法、装置、存储介质、终端及系统 |
CN111290348A (zh) * | 2019-12-18 | 2020-06-16 | 浙江工业大学 | 一种可实现全向移动的多载agv控制系统及其控制方法 |
CN112590746A (zh) * | 2020-12-25 | 2021-04-02 | 南京晨光集团有限责任公司 | 一种基于伺服电动缸的无人配送小车刹车转向系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106054598A (zh) | 机器人自适应转向单神经元pid控制方法 | |
CN107179682B (zh) | 一种被动式负载模拟器及多余力矩抑制方法 | |
CN105109549B (zh) | 基于转速估计的电磁转差离合器自适应模糊滑模控制方法 | |
CN102289204B (zh) | 基于确定学习理论的机械臂通用控制方法 | |
CN102279564B (zh) | 应用智能pid控制器的飞行仿真转台控制系统及方法 | |
US6728615B1 (en) | System and method of controlling vehicle steer-by-wire systems with adjustable steering feel | |
CN103753557B (zh) | 移动式倒立摆系统的自平衡控制方法及自平衡车智能控制系统 | |
US20060025911A1 (en) | Control of a steering wheel system with passive resistance torque | |
CN104942809A (zh) | 基于视觉伺服系统的机械臂动态模糊逼近器 | |
CN105785762A (zh) | 一种基于自适应反步滑模的两轴惯性稳定平台高精度控制方法 | |
CN103279039A (zh) | 一种机器人神经网络式计算力矩控制器训练平台及训练方法 | |
CN101369132A (zh) | 基于神经网络辨识器的永磁球形电动机力学解耦控制方法 | |
CN108418487A (zh) | 一种用于电动汽车的速度脉动抑制方法 | |
González et al. | Observer-based super twisting design: A comparative study on quadrotor altitude control | |
CN106873383A (zh) | 一种降低工业机器人振动的在线控制方法 | |
Wen et al. | Robust adaptive sliding-mode control for permanent magnet spherical actuator with uncertainty using dynamic surface approach | |
CN104898665A (zh) | 巡检机器人轨迹规划的方法和装置 | |
CN106950841A (zh) | 与模型无关的pd‑smc仿生眼运动控制方法 | |
Poulakakis et al. | Experimentally validated bounding models for the Scout II quadrupedal robot | |
CN104898664A (zh) | 一种农用全地形车转向跟踪复合控制方法 | |
CN111062147A (zh) | 四电机联动系统固定时间控制与结构联合优化方法和系统 | |
CN103029851B (zh) | 一种参数自整定伪速率调制器 | |
CN106569503A (zh) | 一种基于触发式预测控制的飞行器控制方法 | |
CN108873893A (zh) | 一种双轮差动小车定位控制方法 | |
Shojaei et al. | A hybrid control scheme for a rotational inverted pendulum |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20161026 |
|
RJ01 | Rejection of invention patent application after publication |