AGV智能小车循迹系统的建模与仿真课件

单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,第六级,第七级,第八级,第九级,2020/7/27,#,单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,第六级,第七级,第八级,第九级,2020/7/27,#,AGV,智能小车循迹系统的,建模与仿真,汇报人： 田佳豪 王嘉津,周博文,邹星星,1,AGV,智能小车简述,1,2,目录,简述,3,4,数学建模,Simulink,建模与仿真,控制系,统设计,AGV,智能小车简述,AGV(Automatic Guided Vehicle),智能小车又称自动导引车，是一种在计算机监控下，根据具体规划和作业要求完成取货、送货、充电等任务的无人驾驶自动化车辆。,AGV,智能小车简述,AGV,智能小车是一种以电池为动力，装有电磁导引设备或光学导引设备，能够自动沿着预定轨道行驶的自动化车辆。,应用,AGV,小车具有以下优势：,（,1,）可以减少捡取货物、搬运货物的劳动力，提高劳动效率。,（,2,）搬运货物时，小车自身不易与周边加工设备发生碰撞，降低了生产事故的发生率。,（,3,）能够与机器人、堆垛机等自动化设备完美配合作业，且能够实现对货物的实时跟踪，大大减少货物丢失的发生率。,（,4,）耗电量小，无噪声污染。,数学建模,王嘉津,问题,该系统的输入和输出是什么？,系统建模的思路？,如何建立运动学模型？,如何建立电机驱动模型？,如何整合模型？,1,输入和输出是什么？,针对对系统的哪一部分建模？,1,该系统的输入和输出是什么？,仿真的目的：找到合适的控制器，使小车及时修正偏差，达到较好的循迹性能。,那么只需要观测小车运行中偏差量变化的状态，便可评估控制器的优劣。,因此输出量应选择为能反映小车偏离轨道程度的变量。,输出量：,当小车修正偏差进行转弯时，是通过后轮（驱动轮）的转速差实现的，决定后轮转速的是电机的电枢电压。,输入量：电枢电压,建模的实质：反映输入电压与 之间的关系,。,2,系统建模的思路？,机电一体化产品的组成：机械本体，传感器，控制系统，驱动器。,此次建模分为两部分：建立运动学模型和建立电机驱动模型。,电机驱动模型要得到的是输入电压与速度（转速）之间的关系。,运动学模型要得到的是速度与 （位移）之间的关系。,最后将两个模型整合形成最终的数学模型。,3,如何建立运动学模型？,目标：寻找 与速度之间的关系。,在分析小车处于转弯状态时的速度时不能将小车当做质点，那么应该研究哪一点的速度？,位移,=,速度,*,时间，但,M,点的速度并不好直接表示，因此考虑用位移之间的数量关系来表示 。,目标：需要寻找 、 与速度之间的关系。,、 均与,O,点速度 相关，且 与电机直接控制的速度 、 相关。,3,如何建立运动学模型？,由于 很小，则,于是最终运动学模型如下：,4,如何建立电机驱动模型？,目标：寻找输入电压与车轮速度（ ）之间的关系。,直流电机动态过程的微分方程如下：,此时忽略车体质量、摩擦阻力对车速的影响，则电机的理想空载转速,=,车轮转速。,理想空载表示负载转矩为零。则：,对于直流伺服电机，,最终的电机驱动模型如下,5,如何整合模型？,经过问题,3,和,4,的解答，分别得到了运动学模型和电机驱动模型，但由于中间变量速度没有统一，仍不能直接将其组合在一起。,为了简化推导过程，以匀速直线运动为例。在没有外部扰动的情况下，左右电机的给定信号相等，,即 ，在此作用下小车产生速度 可视为常数。当外部扰动使小车偏离预定路径时，给定信号将分别加减一个纠偏控制量 ，,即,相应的电机输出速度为：,此模型是一个非线性系统，但由于小车是在确定路线上运行的，它的纠偏过程可视为在给定信号基础上增加一个微小的控制量，因而这样一个非线性化系统就可以采用小偏差线性化的方法将其转化为线性系统。于是有,5,如何整合模型？,此时得到最终数学模型如下：,如何得到？,SIMULINK,建模与仿真,周博文,1 .,状态传递函数,根据前面同学建立的系统模型整理，可以得出系统状态矩微分方程。,选择状态变量,x1=,v,，,x2=,，,x3=E,dm,，并令输入,u=U,，输出,y=E,dm,。可以得到系统的状态矩阵如下,2.,系统可控性分析,将小车与电机的相关参数,代入方程得：,rankB,AB,A,2,B=3,说明系统可控,3.,状态反馈控制器设计,状态反馈,u=v-Kx,，,K=k1,k2,k3,自动引导小车的控制规律可以表示为：,U=v-(k1v+k2+k3E,dm,),状态反馈矩阵,K,的引入，并不增加系统的维数，但是可以通过,K,的自由选取改变闭环系统的特征值，从而使系统获得所要求得性能。,设计状态反馈阵时，要使系统的极点设计成具有两个主导极点，,一个,非主导极点，这样就可以用二阶系统的分析方法进行参数的确定。,我们要求,最大超调量小于等于4.3%，调节时间为4S,。,可以求出系统阻尼,=0.707,，,W,n,=1.06,则极点公式,得到两个共轭极点为,3.,状态反馈控制器设计,在MATLAB的控制系统工具箱中提供了单变量系统极点配置acker(),其格式为K=acker(A,B,p),程序如下：,A=,-0.1,0 0;,10/3 0 0,;,5/3 -3/4 0;,;,B=,7:0:0,;,C=,0:0:1,;,D=0;,Rc=rank(ctrb(A,B);,P=-0.75+,0.707,j,-0.75-,0.707,j,-15;,K=acker(A,B,p)运行结果如下：,4.Simulink,建模,根据数学建模和设计的状态反馈控制器建立如下,Simulink,模型,5.Simulink,仿真,当小车偏离运行轨迹时，现有的系统可以根据传感器测出偏差，接着偏差信号输入控制器，通过控制器输出控制电压修正运行轨迹。通过仿真曲线，得到该系统对直线路径具有较好的跟踪控制性能。,AGV,小车控制系统设计,邹星星,4.1AGV,模拟小车控制总体框图,STM32,主控板,LCD,触摸屏,地标传感器,控制按键,无线,WiFi,磁导航传感器组,警示灯,电机控制模块,LCD,触摸屏,STM32,磁采集控制板,4.2,主控制器,模拟车控制器采用,STM32,来实现，主要任务是对小车进行总体控制，主要功能：接受上位机的命令、任务；向上位机报告小车的实时状态（包括小车目前的所处位置，运行速度、方向、故障状态等）；根据设定的路线，自主的巡航和速度控制。,4.2,磁导航传感器组,磁导航传感器组利用平均排布的,8,个采样点，磁采集传感器组示意图如所示。磁传感器组能够检测出磁条上方,100Gauss,左右的微弱磁场，每个采样点连接一个传感器，一共有,8,路信号输出。因为两个传感器之间的距离是,20mm,，磁条的宽度是,50mm,，因此,AGV,在运行时，磁导航传感器组会有连续的,2,3,路输出采样值。通过连续输出的,2,3,路信号的传感器编号，可以计算出磁条相对于,AGV,车体中线的位置偏差，,AGV,会自动作出调整，确保,AGV,跟踪磁条前行。,20mm,4.,障碍检测,AGV,模拟小车在工作时，会时刻遇见突发状况，比如道路上的障碍物以及走动的人。为了保证,AGV,在行驶过程，自身车体结构的安全性以及工作环境中人和货物的安全，在,AGV,车体前后分别装置了避障检查装簧和警示灯，在一定的范围内，避障装置使,AGV,减速或者停下，在障碍解除后，,AGV,能够自主的重新的正常行驶。,5,通信模块,相比于其他通信总线，,CAN,总线具有突出的可靠性、实时性和灵活性，可靠的实时性保证了数据在传输过程中的安全性，防止丢包的可能性。而本课题中主控电路要求实时对磁采集电路反馈的位置信号进行处理，计算出小车的实时位置偏差，对数据的传输要求比较高，因为本课题在主控电路与磁采集电路之间的通信采用,CAN,总线通信。,5,无线,WiFi,模块,每辆,AGV,小车需要向上位机报告速度、位置等运行状态，设计,WiFi,无线传输模块以上位机。选用,ESP8266,是一款超低功耗的,UART-WiFi,模块。,9,、有时候读书是一种巧妙地避开思考的方法。,9月-24,9月-24,Tuesday, September 17, 2024,10,、阅读一切好书如同和过去最杰出的人谈话。,00:29:18,00:29:18,00:29,9/17/2024 12:29:18 AM,11,、越是没有本领的就越加自命不凡。,9月-24,00:29:18,00:29,Sep-24,17-Sep-24,12,、越是无能的人，越喜欢挑剔别人的错儿。,00:29:18,00:29:18,00:29,Tuesday, September 17, 2024,13,、知人者智，自知者明。胜人者有力，自胜者强。,9月-24,9月-24,00:29:18,00:29:18,September 17, 2024,14,、意志坚强的人能把世界放在手中像泥块一样任意揉捏。,17 九月 2024,12:29:18 上午,00:29:18,9月-24,15,、最具挑战性的挑战莫过于提升自我。,九月 24,12:29 上午,9月-24,00:29,September 17, 2024,16,、业余生活要有意义，不要越轨。,2024/9/17 0:29:18,00:29:18,17 September 2024,17,、一个人即使已登上顶峰，也仍要自强不息。,12:29:18 上午,12:29 上午,00:29:18,9月-24,9,、有时候读书是一种巧妙地避开思考的方法。,9月-24,9月-24,Tuesday, September 17, 2024,10,、阅读一切好书如同和过去最杰出的人谈话。,00:29:18,00:29:18,00:29,9/17/2024 12:29:18 AM,11,、越是没有本领的就越加自命不凡。,9月-24,00:29:18,00:29,Sep-24,17-Sep-24,12,、越是无能的人，越喜欢挑剔别人的错儿。,00:29:18,00:29:18,00:29,Tuesday, September 17, 2024,13,、知人者智，自知者明。胜人者有力，自胜者强。,9月-24,9月-24,00:29:18,00:29:18,September 17, 2024,14,、意志坚强的人能把世界放在手中像泥块一样任意揉捏。,17 九月 2024,12:29:18 上午,00:29:18,9月-24,15,、最具挑战性的挑战莫过于提升自我。,九月 24,12:29 上午,9月-24,00:29,September 17, 2024,16,、业余生活要有意义，不要越轨。,2024/9/17 0:29:18,00:29:18,17 September 2024,17,、一个人即使已登上顶峰，也仍要自强不息。,12:29:18 上午,12:29 上午,00:29:18,9月-24,9,、有时候读书是一种巧妙地避开思考的方法。,9月-24,9月-24,Tuesday, September 17, 2024,10,、阅读一切好书如同和过去最杰出的人谈话。,00:29:18,00:29:18,00:29,9/17/2024 12:29:18 AM,11,、越是没有本领的就越加自命不凡。,9月-24,00:29:18,00:29,Sep-24,17-Sep-24,12,、越是无能的人，越喜欢挑剔别人的错儿。,00:29:18,00:29:18,00:29,Tuesday, September 17, 2024,13,、知人者智，自知者明。胜人者有力，自胜者强。,9月-24,9月-24,00:29:18,00:29:18,September 17, 2024,14,、意志坚强的人能把世界放在手中像泥块一样任意揉捏。,17 九月 2024,12:29:18 上午,00:29:18,9月-24,15,、最具挑战性的挑战莫过于提升自我。,九月 24,12:29 上午,9月-24,00:29,September 17, 2024,16,、业余生活要有意义，不要越轨。,2024/9/17 0:29:18,00:29:18,17 September 2024,17,、一个人即使已登上顶峰，也仍要自强不息。,12:29:18 上午,12:29 上午,00:29:18,9月-24,谢谢大家,没伞的孩子奔跑在路上，加油,90,大叔！,