分类:电子论文 时间:2022-05-14 热度:938
摘 要:文章是基于 STM32 单片机,采用 C 语言进行编程的一款循迹式全向移动底盘,根据使用要求,该底盘可实现在场地内的全向移动并进行准确的定点停车等工作。文章对小车底盘的机械设计方案、硬件电路设计方案以及相关程序进行详细叙述,并对现有的定位方式提出更为准确的改进方法,为学习自动化控制、人工智能以及机器人相关知识的人群提供参考。
关键词:智能物流小车;STM32;循迹;陀螺仪
目前网上购物发展迅速,导致物流行业急剧发展,但传统的分拣模式已不能满足物流行业的需求,整个物流行业也逐渐向智能化、自动化发展,此时智能物流机器人就应运而生。本文提出一种用来配合物品运输的循迹式全向底盘系统,并对其机械设计方案、硬件电路设计方案以及相关程序算法进行详细介绍。
1 机械设计方案
1.1 车身框架设计
车身框架作为底盘上最重要的部件,起着连接行走机构,安装其他硬件,承载所有重量的重要作用,合理地安排各个硬件在车体上的位置,不仅可以使得整个系统看起来简洁,而且有效的布局还可以控制车体的重心位置,减少在系统工作过程中因为机械设计错误带来的干扰。
为了保证底盘的离地间隙较小和整个系统的重心较低,提高整个系统运行的稳定性,将车身框架的投影面设计为一个正方形并且采取了上下双层板的结构。而对于上下两板的连接,将减速电机支架作为连接件,形成了一个坚固的盒式结构,既可以保证 4 个麦克纳姆轮全部接触地面,同时也不会因承载力过大而发生严重的形变。上下两板规格和材质均采用 3 mm 环氧板,雕刻机加工。车身框架结构如图 1 所示。图 1 车身框架结构
1.2 行走机构设计
物流小车需要实现在作业区域的全向移动,针对该问题,采取的解决方案为麦克纳姆轮全向移动方案。
基于麦克纳姆轮技术的全方位运动,设备可以实现前行、横移、斜行、旋转及其组合等运动方式。因此在此基础上,智能物流小车平台可以实现在转运空间有限、作业通道狭窄的环境中运作,不但可以提升工作效率,而且在降低人力成本方面具有明显的效果。
2 硬件电路设计方案
智能物流小车底盘硬件电路主要分为信息采集定位单元、信息处理单元、运动执行单元、矫正单元 4 个部分,采用11.1 V 直流电源为全部单元进行供电。底盘系统的硬件电路结构如图 2 所示。
2.1 信息采集定位单元
根据设计要求,物流小车要对位于地面上的黑色线条进行识别并沿黑线进行运动,为了保证识别的准确性和降低容错率,我们采用了 4 组 7 路数字量循迹传感器,并结合数据混合算法和滤波算法,将其识别率大大提高。安装位置以及实物如图 3 所示。
智能物流小车的循迹使用了 7 路数字量循迹传感器检测黑线。车身前后左右各布置一套传感器。当物流车向各个方向平移时,各个方向的传感器起到辅助行进作用,而与其行进方向垂直的灰度传感器负责对行进的格数进行计数。从出发点开始,物流小车会根据程序规定的方向和格数,按照预定的路径行进,从而到达各个指定位置。
2.2 信息处理单元
如何对采集到的全部信息进行高效快速地处理,该物流小车底盘系统采用了 STM32F103rct6 单片机。该型单片机拥有较高的性能,主流的 Cortex 内核,并且可支持丰富的外设,功耗较低,性价比较高,除此之外还拥有强大的软件支持。
2.3 运动执行单元
底盘的运动执行单元采用了大疆公司的 RM C610 无刷电机调速器和 RM M2006 P36 直流无刷减速电机以及 RM 电调中心板 2。
11.1 V 直流电源接在电调中心板上,在 4 个接线端子上安装电调电源线和信号线,再将直流电机接线端子与电调另一端相连,运动执行单元组成完毕。而运动执行机构与 STM32 单片机之间通过 CAN 总线进行通信。
2.4 矫正单元
在底盘运动过程中,行进方向在受到外界扰动的情况下,会产生一定程度上的偏移量,此时就需要系统对其进行矫正。为此,该底盘系统采用了高精度航向角陀螺仪 HWT101DT 实时对底盘状态进行监控和矫正。
2.4.1 PID 角度控制
车身角度在运动和搬运物料过程中,因轮子摩擦力不足,重心偏移等外界扰动,车身角度发生偏转,在 PID 角度控制下能够自动恢复到初始车身角度,保证车身角度一直稳定在初始角度即目标角度。而整个平衡回路必须同时具备良好的冲击响应和阶跃响应性能,即要求对冲击信号和阶跃信号有响应的快速性、平滑性和稳定性。换言之,要求系统上升时间短、无震荡、稳态误差为零。
全程中以实时检测的车身角度为输入量,车身初始角度为目标值,每次对角度的误差进行积分,对角度进行微分,最后通过 Kp 将输出量转化成合适的速度差,将该速度差加上基本速度为实际速度,达到物流车运行全程时刻矫正自身角度的目的。
2.4.2 PID 速度控制 Robomaster 的电机带有霍尔传感器,可以反馈转速以及位置信息,因此可以通过闭环方式进行控制。期望即电机目标转速,反馈即我们通过霍尔传感器获得的电机实际转速,将其做差得到误差,然后送入控制器中。控制器根据内部的算法得到结果,使电机的实际转速恰好等于目标转速。由于误差和控制器输出都是时变的,
3 现有定位方式改进方案
目前物流车循迹方式采用的是 7 路数字模拟灰度传感器,但此方案适用于速度较小的情况下,速度过大会导致每次停车点位置偏移过大,而物流搬运对小车的运行速度和定位准确度有着很高的要求,下步改进方案通过光流定位实现物流车的高速运行和定位精准。
本文来源于:《科技创新与应用》杂志是经中国新闻出版总署备案的学术期刊。主管单位:黑龙江出版集团有限公司,主办单位:黑龙江省报刊出版有限公司、黑龙江省科学技术协会。刊登具有一定学术和应用价值的学术文献和反映各学科、各领域的新成果、新工艺、新产品等方面的论述文章,为科技工作者搭建学术交流平台。
光流是通过检测图像中光点和暗点的移动,来判断图像中像素点相对于物流车的移动速度。光流传感器能对视觉运动进行测量并输出二维测量值,在得到光流 X、 Y 轴方向的速度之后,通过积分便可以得到位置数据。最终使用的数据为加速度计数据与光流数据融合,以便于实现更好的效果。光流传感器的运用可得到场地所有点的坐标,引入 PID 算法,令目标坐标为期望,实现物流车的准确定位。
4 结束语
本项目是基于 STM32 单片机,采用 C 语言进行编程的一款循迹式全向移动底盘。本文根据智能物流小车的使用要求,对物流小车的底盘进行了机械设计和硬件电路设计。整个底盘系统实现了在接收任务之后,自主地进行循迹,定点停车等工作,并在实施任务过程中,矫正单元实时对误差进行监控并矫正,确保了任务完成的准确度,为学习自动化控制、人工智能以及机器人相关知识的人群提供了宝贵经验。但整个系统的定位方式还有改进空间,在升级硬件和改进算法之后,定位精度会大大提高。——论文作者:胡振圆 1 ,王路平 2*,付 睿 3
参考文献:
[1]李珂嘉,陈选文,王保建,等.基于智能制造场景的物流机器人小车系统优化[J].信息记录材料,2021,22(1):170-172.
[2]向楠,陆会娥.物流自动化智能可避障搬运小车系统设计[J].广东石油化工学院学报,2017(4):30-33.
[3]汪弘达,熊小青,陈晟,等.智能物流搬运小车[J].科技创新与应用, 2019(6):113-114.
[4]陈越超,程志伟.智能物流车控制系统设计[J].科技创新导报,2019,16 (25):160-161.
[5]林豪,王新雨,徐玥.基于高性能单片机的智能物流小车研究与设计[J].河南科技,2020(5):24-28.
[6]郭伟.自动寻迹搬运车控制系统设计与实现[J].中国铸造装备与技术,2015(4):39-42.
文章名称:智能物流小车底盘系统设计