滚球控制系统摘要该滚球系统由Kinetis—K60单片机控制模块、位置采集模块、板球模块、人机交互模块、电源模块以及板球机械结构组成的闭环控制系统
它由OV7620摄像头进行滚球位置采集,单片机对摄像头输入信息进行处理,用位置式PID算法进行运算,输出脉冲控制电机驱动为SH-20403驱动的42BYG250A电机转动,使滑轮缠绕吊线,改变底板所受吊线的拉力,进而控制地板倾斜让滚球到达指定位置,用人机交互模块中的按键控制与题目相应程序的运行
在该滚球系统中,滚球可在规定时间内在不经过非指定区域条件下到达指定区域,并可以在指定区域内停留规定时间,完成了大赛本科B组基本要求
关键字:Kinetis—K60单片机;OV7620摄像头;42BYG250a电机;SH-20403驱动;位置式PID算法;闭环系统1一
系统方案滚球控制系统主要包括单片机控制模块、电源模块、位置采集模块、板球模块、人机交互模块以及板球机械结构
系统通过位置采集模块时刻采集滚球位置信息,将信息输入给单片机控制模块,单片机对输入的信息进行处理,通控制脉冲发生器,通过一定方法让底板发生倾斜,控制滚球运动
人机交互模块中的按键选择程序运行
图1系统结构图1
板球模块方案的选择与论证方案一:将推杆电机作为支撑放于板下,通过推杆电机的推动使底板发生倾斜
方案二:将两个42byg250a电机固定到顶板,在上面捆绑上吊线,经过顶板滑轮固定到底板,使底板悬空,通过电机的转动拉动吊线使底板发生倾斜
两方案比较之后我们选择方案二为滚球控制系统方案
两方案比较如表一所示表1板球模块方案比较万案一优势抗外力自然因素干扰强,结构不复杂,很经典的滚球控制方式资料便于查找
劣势推杆电机在推板过程中会滑动产生相对位移,推杆电机反应慢,每次电机运行反转方向的误差会累计
万案二优势42byg250a电机反应快,电机运行反转方向时延时小,误差可以忽