还剩6页未读,继续阅读
文本内容:
2012年意法半导体iNEMO®校园设计大赛项目计划书项目名称基于两轮自平衡重力感应控制的智能车学校哈尔滨工业大学团队名称机械梦工场团队成员崔金非徐志剑卢子琦原为一指导老师侯成宇团队____团队____
1、项目摘要两轮自平衡小车是__机器人研究中的一个重要领域两轮自平衡机器人两轮共轴、__驱动、车身中心位于车轮轴上方,通过运动保持平衡,可直立行走由于特殊的结构,其适应地形变化能力强,运动灵活可以胜任一些复杂环境里的工作另一方面,从研究意义上看,自平衡小车系统是一个集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的综合复杂非线性系统近年来,两轮自平衡电动车以其行走灵活、便利、节能等特点赢得人们的青睐本项目将利用iNEMO®传感器平台制作一个可以自行实现平衡的车体,并通过一个同样基于iNEMO®传感器平台的智能控制器来实现对它的控制加速度传感器和陀螺仪的结合实现车体的平衡,地磁传感器和加速度传感器的结合实现对车体灵活的控制
二、项目背景
1.背景简介两轮自平衡车,从最开始的只是想让它立起来到现在的如何让它跑得更快,更加稳定,研究者们倾注了大量心血毫无疑问,高度灵活与节能的两轮自平衡具有广阔的市场前景,无论是民用领域还是军事领域一个人性化的控制器,直接关系到产品的使用灵活性和应用前景过往的车体控制器大多是以摇杆式和按键式为主,虽然能够们满足简单的前进后退和转弯操作,但远___人性化iNEMO®传感器平台拥有多方位感知功能,这就使的更人性化的控制器的制作更加具有可行性
2.主题想法我们的设计方案是将比赛所给的STEVAL-MKI109V2及STEVAL-MKI124V1的功能最大化,正如上面所述,如果我们能够同时使用两个eMotionSTM32平台来完成我们的制作的话,那么毫无疑问这将会是两个iNEMO®传感器的__结合!由于iNEMO是独一无二的具有10个自由度的MEMS传感器应用评估__工具,评估板整合了3轴线性加速度传感器、3轴角速率传感器、3轴磁场运动传感器以及压力/高度传感器,所有的传感器均由STM3232位微控制器控制,我们用一个传感器来控制两轮车的平衡,再用一个传感器平台制作控制器通过无线控制来控制两轮车的体态还有我们还可以在车上还可以显示当时的气压和温度,这样就增加了两轮车的功能,也能使传感器平台的功能发挥到最大化
3.设计创意我们的主要创意是在两轮自平衡的平台和控制器上的iNEMO®平__美结合,使整个系统更加人性化一个传感器进行车体的平衡控制,一个传感器平台进行运动控制,这充分利用了iNEMO®平台的三轴线性加速度传感器、三轴角速度传感器以及三轴地磁计功能我们的控制器是通过重力感应,地磁传感器和陀螺仪来对车体进行体态控制,多种传感器的结合使用增加了两轮车的可操作性4.作品的实用性能在__机器人的应用中导航和定位是__机器人研究的两个重要问题随着国民经济的发展导航定位系统已经从传统的军事__航海等军事领域向民用领域发展车载导航系统发展非常迅速在机器人自主导航电动代步车和智能交通中得到了广泛的应用期间经历了一个从传统导航单一GPS导航到组合导航的发展过程两轮自平衡机器人是一种特殊的倒立摆式的__机器人这种机器人两轮共轴__驱动车身重心倒置于车轮轴上方通过运动保持平衡可直立行走.其适应地形变化能力强运动灵活可以胜任一些复杂环境里的工作两轮自平衡机器人是一个集环境感知动态决策与路径规划行为控制与执行等多种功能于一体的综合系统.如何保持车体系统在空载载人前进后退旋转以及刹车等各种运动状态各种环境下平衡及对机器人进行实时导航和定位是保证其正常工作的关键问题.两轮自平衡机器人有着相当广泛的应用前景其典型应用包括通勤车空间探索战场侦察危险品运输排雷灭火智能轮椅玩具等场合.例如将两轮小车作为小范围短距离交通工具将更加方便灵活环保;智能轮椅可为残疾人提供便捷服务
三、方案实施车体直立方案将iNEMO平台__于车体上,通过其上的加速度传感器,陀螺仪和地磁传感器来感知车体的姿态变化将变化量传送给主控单片机,单片机通过通过计算得出数值并以PWM的形式该电机发出指令将陀螺仪和加速度传感器的测量值减常值误差,得到角速度和加速度,并对角速度进行积分,然后对陀螺仪积分和加速度计的数值进行融合融合分为两部分,实时融合和__融合实时融合每一次算法周期都要执行,而__融合没256个检测周期执行一次实时融合
1.将陀螺仪积分和加表滤波后的值做差
2.按照情况对差值进行衰减,并作限幅处理
3.将衰减值加入到角度中__融合__融合主要包括两个部分,一是对角速度的漂移进行估计(估计值是要在每一个控制周期都耦合到角度中的),二是对陀螺仪的常值误差(也就是陀螺仪中立点)进行实时的修正
1.将陀螺仪积分的积分和加速度积分做差,___这里要使用加表积分和陀螺仪积分的积分,因为在256个检测周期内,有一些加速度计的值含有有害的加速度分量,如果只使用一个时刻的加表值对陀螺仪漂移进行估计,显然估计值不会准确,使用多个周期的值进行叠加后做座平均处理,可以减小随机的有害加速度对估计陀螺仪漂移过程中所锁产生的影响
2.将上面两个值进行衰减,得到估计的陀螺仪漂移
3.对使考虑了陀螺仪漂移和不考虑陀螺仪漂移得到的角度做差,如果这两个值较大,说明陀螺仪在前段时间内测到的角速率不够准确,需要对差值误差(也就是陀螺仪中立点)进行修正,修正幅度和差值有关控制器方案在一个固定的位置,地磁传感器与磁场的夹角是一个定值当它旋转时,这个夹角就会发生变化显然,这个夹角反映了传感器所转过的角度将这个角度只通过无线设备发送给主控单片机,就可以达到车体的旋转,让车体的视角和人的视角始终保持一致当然,利用加速度传感器的方式也可以实现旋转的控制,但是很明显它的一个缺点就是无法保证视角的一致为了追求人性化的效果,我们选择地磁传感器为主,加速度传感器为辅的方案,可以实现两者的切换示意图如下关于车体的前进方案,我们用加速度传感器来实现,通过测量加速的传感器倾斜的角度来实现车体的前进,后退和速度大小的控制示意图如下
四、预期成果车体方面,单片机能够通过运用传感器所采数据实现自平衡前进,后退,旋转不会出现晃动情况,实现车体稳定的目标控制器方面,STM32能够将计算所得数据通过无线方式传送给主控单片机,向单片机发出指令,实现车体的各种体态运动控制
五、可行性分析两轮自平衡一直备受人们的青睐,并且正在向更加智能的方向发展强大的10个自由度iNEMO®传感器平台将使这发展的更为迅速,并为更加人性化的控制器的改进减小了阻力我们的团队曾多次参加各类电子设计比赛并取得了不错的成绩,具有丰富的电子设计经验崔金非对电子设计和制作充满兴趣和热情,擅长单片机与程序设计,能熟练编程__R,ARM,DSC,DSP和FPGA有丰富的程序编写经验,且有很强的学习能力徐志剑有很强的动手意识,熟于模拟电路设计和数字电路设计,主要负责硬件平台的搭建卢子琦在数学和物理模型建立方面具有很强的能力,负责机械与建模原为一对电子制作有浓厚的兴趣,有一定的物理和模电基础,负责机械和电路的搭建
六、工作计划
12.07-
12.08熟悉使用iNEMO®传感器平台
12.08-
12.09搭建车体和控制器硬件平台
12.09-
12.10完成两部分的__调试
12.10-
12.11联合调试,改进不足,最终定型作品
七、参加本次竞赛的想法及建议通过参加本次竞赛,我们想要了解当今最前沿的电子技术的发展状况与趋势通过自己的能力,将最新的技术应用于实际,发挥它的最大作用希望在日后的竞赛中主办方能提供更多的传感器供参赛队伍选择。