基于电阻屏的板球控制系统

基于电阻屏的板球控制系统王宪菊，陈韬，黄修道，胡锦静（阜阳师范大学物理与电子工程学院，安徽阜阳236037）摘要：板球系统作为经典控制对象球杆系统的二维扩展，其实质上是把对小球位置的控制从直线延伸到平面，控制小球在平面内完成定位和轨迹跟踪。

本系统采用位置式PID 控制算法实现对小球的精准定位和轨迹跟踪，自主完成板球系统机械结构和控制电路的设计。

通过上位机实时观测小球的响应曲线，对控制数据进行分析，反复调整PID 参数，最终实现小球在平板上快速定位、稳定跟踪的目的。

实验结果表明，该板球控制系统具有控制小球快速定位、精准轨迹跟踪的性能，以及较强的抗扰动能力。

关键词：控制；板球系统；PID 算法；小球定位；轨迹跟踪DOI ：10.13757/34-1328/n.2019.03.012中图分类号：TP2文献标识码：A 文章编号：1007-4260（2019）03-0048-04A Cricket Controlling System Based on Resistive ScreenWANG Xianju,CHEN Tao,HUANG Xiudao,HU Jinjing(School of Physics and Electronic Engineering,Fuyang Normal University,Fuyang 236037,China )Abstract:As a two-dimensional extension of the classic control object “cue system ”,cricket ball system essentially ex-tends the control of the position of the ball from straight line to plane,and controls the ball to complete positioning and tracktracking in the plane.This system uses the position PID control algorithm to realize the accurate positioning and trajectorytracking of the ball,and independently completes the design of the mechanical structure and control circuit of the cricket sys-tem.Through the real-time observation of the response curve of the ball by the upper computer,the control data is analyzed,and the PID parameters are adjusted repeatedly.Finally,the goal of rapid positioning and stable tracking of the ball on theplate is achieved.The experimental results show that the cricket ball control system has the properties of fast positioning,accu-rate trajectory tracking and strong anti-disturbance ability.Key words:control;system of cricket;PID algorithm;small ball positioning;trajectory tracking板球系统是一个非线性、多变量、复杂的控制系统[1-9]。

简单定义即通过不断调整平板的角度来达到控制小球在平板上的位置和轨迹跟踪目的的机械系统[2，4-5]。

板球系统作为控制理论实验平台，主要用于验证各种控制算法的优劣[6-10]，本文也是基于此首先完成板球控制系统的机械结构和控制电路设计，然后通过理论分析和数学建模得到系统的状态方程，进而对状态方程进行计算和处理得到系统的传递函数。

根据分析结论可知，X 轴和Y 轴相互独立，因此，对X 和Y 轴分别设计了PID 控制器。

1板球系统的数学建模及定性分析基于电阻屏的板球系统机械结构如图1所示，由电阻触摸屏、托盘、小球、舵机、支架、连杆和控制电路收稿日期：2018-12-15基金项目：阜阳师范大学校级科研一般项目（2019FSKJ10），国家自然科学基金（41701254）和阜阳市政府-阜阳师范大学横向项目（XDHX201729）作者简介：王宪菊（1984—），女，河南开封人，硕士，阜阳师范大学物理与电子工程学院讲师，研究方向为智能控制。

E-mail ：943876886@2019年9月第25卷第3期安庆师范大学学报(自然科学版)Journal of Anqing Normal University(Natural Science Edition)Sep.2019Vol.25No.3第3期组成，控制器采用STM32系列单片机。

首先，在触摸屏上建立直角坐标系，通过采集电阻屏输出电压值计算小球的实际坐标位置；然后，把实际坐标数据与设定位置数据进行比较，运用PID 算法得出控制舵机角度的PWM 控制量；最后，控制器发送给舵机，舵机带动连杆转动，从而控制小球的位置和运动状态。

参照板球系统机械图，以触摸屏为二维平面，平面左下角设为坐标原点，建立x ,y 两个方向的直角坐标系；以电阻屏中心点（133，100）为支撑点，在电阻屏相邻的两个边下方安装舵机，实现平板x 、y 轴方向转动。

板球系统的机械动力学模型如图2所示。

图1基于电阻屏的板球控制系统机械结构图图2板球系统机械动力学模型利用牛顿定律和拉格朗日方程,对以上模型进行动力学分析，计算得出以下状态方程：x :()m +I b r 2b x -m (xα2+yαβ)+mg sin α=0,（1）y :()m +I b r 2b y -m (yβ2+xαβ)+mg sin β=0,（2）α:(I b +I P +mx 2)α+m (xyβ+x yβ+xy β+2xx α)+mgx cos α=τx ,（3）β:(I b +I P +my 2)β+m (xyα+x yα+xy α+2xx β)+mgx cos β=Fτy 。

（4）式中各物理参数如表1所示。

若选取平板的倾角α、β为控制量，由于力矩不会影响舵机的位置，所以方程（3）、（4）可以忽略。

在平衡状态下，平板处于水平位置，即α=0，β=0，因为平板的转动角度不大，大约在±0.1rad 范围之内，所以正弦函数可以用角度代替，即sin α≈α，sin β≈β。

表1板球系统物理参数参数mr bx ,yα,βI bI pτx ,τy 意义小球的质量小球的半径小球在x ,y 方向上的位移平板x ,y 方向倾角小球转动惯量平板转动惯量平板x ,y 方向转矩单位g mm mm rad kg·m 2kg·m 2kg·m 2/s 2对微分方程(1),(2)进行线性化处理，令x =[x 1,x 2,x 3,x 4]T ，y =x ,u =[α,β]T ，忽略摩擦力后，系统的状态描述方程为{x =Ax +Bu y =x ,（5）其中，A =éëêêêêùûúúúú0100000000010000，B =éëêêêêùûúúúú00-λg 0000-λg ，λ=m (m +I b r b 2)。

小球的转动惯量I b =25mr b 2，带入λ中，有王宪菊，陈韬，黄修道，等：基于电阻屏的板球控制系统··49安庆师范大学学报（自然科学版）2019年B =éëêêêêêêêêùûúúúúúúúú00-57g0000-57g 。

由此可知系统可控，且x 轴和y 轴的控制相互独立，可以针对x 轴和y 轴分别设计控制器，传递函数的表达式均为G (s )=7s 2。

2系统控制方案由于板球系统是一个欠驱动系统[3]，对实时性要求较高，而积分调节会降低系统稳定性，使动态响应变慢，因此本系统采用位置式PD 算法控制舵机的角度和速度。

控制方案如图3所示。

图3系统控制方案系统完成初始化后，电阻触摸屏定时采集小球的位置坐标(x ,y )，与目标坐标(x d ,y d )进行比较，得差值(x d -x ,y d -y )。

由系统的状态方程（5）可知，x 轴和y 轴相互独立，可分别对其设计PD 控制器。

PD 表达式为p wm (k )=Kp ×e (k )+Kd ×[e (k )-e (k -1)],（6）其中，e (k )代表本次偏差；e (k -1)代表上一次的偏差；p wm (k )代表本次输出的舵机角度控制量；PD 控制器输出控制量给舵机，舵机带动连杆转动，使平板发生相应角度的倾斜，控制小球动态的稳定在目标点或沿规划轨迹运动。

3控制实验分析及参数整定按照图3所示的控制方案设计板球系统的控制算法，设平板左下角为坐标原点，测得中心点（支撑点）的坐标值为(133,100)，板球系统的物理参数：小球质量m =250g ，小球半径r b =20mm ，平板长度L =266mm ，平板宽度d =200mm 。

参照系统状态方程（5），由于A 为已知，可选择控制u 来消除系统非线性，然后根据线性控制原理来选择K p 和K d ，具体实现方法为使多项式s 2+K d s +K p 所有根都落在复平面左上象限，即需要下面方程的根为负值s 2+K d s +K p =0。

（7）可设方程的两个根均为-λ，有(s +λ)2=0，即s 2+2λs +λ2=0，则可设计K d =2λ,K p =λ2。

改变λ值，通过实验，发现λ＝8时中心点定位比较准确，如图4所示，x 轴跟踪曲线稳定后的平均误差为0.5mm ，y 轴跟踪曲线稳定后的平均误差为1.5mm ；λ＝9时圆轨迹曲线较理想，如图5所示，平均偏离误差为1mm 。