机器人pid控制算法研究与实现.docVIP

机器人PID控制算法研究与实现 引言 PID控制技术广泛应用于工业控制各个领域,其控制结构简单,参数定义明确,易于实现,其中P(Proportional)是比例项,I(Integral)是积分项,D(Derivative)是微分项。当被控对象变化随机性较大,不能精确建立控制模型时,PID控制器能够很好地发挥控制作用。在实际应用中可以采用P、PI、PD或PID等控制形式,也可以加入人工智能模糊控制手段,具体要根据被控制对象系统响应变化特点进行选择与调整。PID调节器是在系统运行过程中将设定值r(t)与输出值c(t)进行比较构成控制偏差e(t)=r(t)-c(t),通过线性组合将其按比例、积分、微分运算后生成控制量,实现实时自适应控制。PID系统典型控制结构如图1所示,PID调节器的数学模型如公式(1)所示。 其中,u(t)为输出项;KP为比例放大系数;TI为积分时间;TD为微分时间;e(t)为误差值;u0为控制量基准值。 比例放大系数KP能加快系统响应速度,但容易产生超调现象,在机器人巡线行走过程中会出现左右搬动现象;积分时间参数TI主要作用是消除系统的稳态误差;微分时间参数TD作用是改善系统的动态性能,对误差趋势能够进行提前干预。 1 双轮巡线机器人行走结构设计 文中控制的机器人依靠平台上两个直流电机(图2中A、B所示)驱动轮子行走,在机器人平台前后安装有两根巡线传感器(图2中C、D所示),每根传感器由16路采集点组成,为保证机器人平台的稳定,在机器人前后安装有万向轮(图2中E所示)。机器人在行走过程中通过巡线传感器读取场地中的引导白线完成行走动作。驱动机器人的两个直流电机特性存在差异,给两个轮子电机加上相同的PWM也不能保证沿着直线行走,必须引入一定控制算法,保证机器人在不偏离引导线的前提下快速行进。文中采用PID控制算法,通过反复实验整合调优PID算法中的参数,使之能够顺畅自如地以直线或曲线巡线行走。机器人平台结构如图2所示。 2 数字化PID控制算法设计 文中机器人行走控制处理芯片为80C51单片机,在实现算法设计过程中首先要将理论上的PID算法进行数字化处理,其次要根据机器人行走特性做好PID算法中比例、积分、微分因子的选取和采样处理。下面首先从影响PID算法最大的比例项设计入手开始进行PID方程构建分析。 (1)比例项的设计。 在PID控制算法中,比例因子是关键所在。首先要确定控制模型中的比例采样方法,构建比例方程。在机器人运行过程中,前后两根16路传感器不断将扫描信号传递给CUP,通过前后两根16路传感器信息能实时判定车身的位置状态,根据传感器位置与中心线的偏差e(t),再找出适当的比例因子就可以构建PID控制系统中的比例控制项。图3列出了机器人在行进过程中的四种状态类型,在图中将16路巡线传感器中心定位为刻度零,前排16路传感器在X轴方向规定为左+右-,后排16路传感器在X轴方向规定为左-右+,通过程序扫描可以得到瞬时机器人前后两根16路传感器的采集位置b1,b2值(取值范围1~16),z1,z2代表前后巡线传感器同时扫描到白线的采集点个数。通过公式(2)能够准确计算出引导白线中心点在前后16路传感器上对应点的位置信息。 其中,N1为前16路传感器在引导白线中心位置信息;N2为后16路传感器在引导白线中心位置信息。当N1,N2结果都为零时,表示引导白线刚好位于机器人中心线上。 根据N1,N2的位置信息,可以构建出PID算法中的比例方程,方程中选用了不同的比例因子,前排传感器在巡线过程中起到关键作用,因此前排的比例系数x1略大于后排传感器的比例系数x2。比例因子选取要根据机器人现场具体调试决定,构建的方程如公式(3)所示。式中,根据机器人的偏差信息,能够生成控制驱动机器人电机的PWM值,根据机器人车身的状态将这个值分别影响到机器人的左右电机上。 针对P控制算法,程序算法设计如下所示。在程序中PWM电机驱动占空比最大值定义为200,motor为驱动电机转动函数,参数l,r代表驱动左右侧电机;f,b代表向前向后,其中的SB代表电机驱动的基础值,根据算出的PWM程序自动调节机器人的行走方向。 for(p=0;p a1=xin_xi0x8000;//xin_xi代表前排传感器数据信息 a2=xin_xi20x8000;//xin_xi2代表后排传感器数据信息 if((a10)(b1 if(a10)z1++;//累计前排传感器在白线上个数 if((a20)(b2 if(a20)z2++;//累计后排传感器在白线上个数 xin_xi=xin_xi xin_xi2=xin_xi2 } N1=b1+z1/2-8;//计算出前排传感器在白线中心位置 N2=b2+z2/2-8;//计算出后排传感器在白线中心位置 PWM=N1*5+