《基于双MCU实现的飞行机器人系统.pdf》由会员分享,可在线阅读,更多相关《基于双MCU实现的飞行机器人系统.pdf(8页珍藏版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 102759926 A(43)申请公布日 2012.10.31CN102759926A*CN102759926A*(21)申请号 201210240792.0(22)申请日 2012.07.11G05D 1/08(2006.01)(71)申请人华北电力大学地址 102206 北京市昌平区朱辛庄北农路2号(72)发明人柳长安 吴华 杨国田 刘春阳李钊(74)专利代理机构北京众合诚成知识产权代理有限公司 11246代理人陈波(54) 发明名称基于双MCU实现的飞行机器人系统(57) 摘要本发明公开了飞行机器人系统设计领域的一种基于双MCU实现的飞行机器人系统。其特征在于,。
2、所述系统包括电源模块、通信模块、第一微控制器单元、第二微控制器单元和双口RAM。本发明采用双口RAM,解决了快速与慢速设备之间的矛盾,使得通信的两个微型控制器单元MCU可以按照各自的速度对数据进行处理和交换,保证系统的可靠性。(51)Int.Cl.权利要求书1页 说明书3页 附图3页(19)中华人民共和国国家知识产权局(12)发明专利申请权利要求书 1 页 说明书 3 页 附图 3 页1/1页21.一种基于双MCU实现的飞行机器人系统,其特征在于,所述系统包括电源模块、通信模块、第一微控制器单元、第二微控制器单元和双口RAM;其中,所述电源模块分别与所述通信模块、第一微控制器单元、第二微控制器。
3、单元和双口RAM连接,用于为整个飞行机器人的正常工作提供能量;所述通信模块分别与所述电源模块和第一微控制器单元连接;用于将飞行机器人的实时状态信息发送至远端PC,对飞行机器人的工作状态进行实施监视;所述第一微控制器单元分别与所述通信模块、电源模块和双口RAM连接;用于整个系统的控制与任务调度,将获得的传感器数据存放入双口RAM的下行数据区;所述第二微控制器单元分别与所述电源模块和双口RAM连接;用于实时解算当前飞行姿态,将实时解算的飞行机器人空中姿态数据存放如双口RAM的上行数据区;所述双口RAM分别与所述电源模块、第一微控制器单元和第二微控制器单元;用于使通信的第一微控制器单元和第二微控制器。
4、单元可以按照各自的速度对数据进行处理和交换。2.根据权利要求1所述的一种基于双MCU实现的飞行机器人系统,其特征在于,所述双口RAM包括邮箱Mail Box、上行数据区和下行数据区;所述邮箱Mail Box用于两个微控制器单元MCU在信息交互时产生中断;所述上行数据区用于存储第二微控制器单元实时解算的飞行机器人空中姿态数据;所述下行数据区用于存储第一微控制器单元所得到的传感器数据。权 利 要 求 书CN 102759926 A1/3页3基于双 MCU 实现的飞行机器人系统技术领域0001 本发明属于飞行机器人系统设计领域,尤其涉及一种基于双MCU实现的飞行机器人系统。背景技术0002 随着微机。
5、电系统MEMS的发展,飞行机器人姿态传感器的采样频率不断提高,姿态控制算法越来越复杂,这样需要运算能力更强的微型控制器单元MCU对传感器采样获得数据进行处理。原有的单微型控制器单元MCU飞行机器人控制系统中,所有的控制计算功能均由一个微型控制器单元MCU完成,其工作频率较高,但操作复杂。0003 在双微型控制器单元MCU实现的飞行机器人控制系统中,二者之间的数据共享有串行通信方式、并行通信方式、双口RAM等方式。串行总线多微型控制器单元MCU中,各微型控制器单元MCU之间的通信十分方便,只是传输的速度较慢,传递的信息量不宜过大;并行通信方式可交换的数据量大,传输速度较快,能满足大多数应用场合速。
6、度的要求。但只适用于系统中互通信的两个微型控制器单元MCU是处于同一速度级别的情况,否则,微型控制器单元MCU之间极大的通信数据量和处理速度的差异,易造成数据处理中的“瓶颈”现象;双口RAM的功能特点解决了快速与慢速设备之间的矛盾,使得通信的两个微型控制器单元MCU可以按照各自的速度对数据进行处理和交换,保证系统的可靠性。发明内容0004 针对上面技术背景中描述的目前使用的飞行机器人控制系统,在数据处理的速度和可靠性方面存在的不足,本发明提出了一种基于双MCU实现的飞行机器人系统。0005 本发明的技术方案是,一种基于双MCU实现的飞行机器人系统,其特征在于,所述系统包括电源模块、通信模块、第。
7、一微控制器单元、第二微控制器单元和双口RAM;0006 其中,所述电源模块分别与所述通信模块、第一微控制器单元、第二微控制器单元和双口RAM连接;用于为整个飞行机器人的正常工作提供能量;0007 所述通信模块分别与所述电源模块和第一微控制器单元连接;用于将飞行机器人的实时状态信息发送至远端PC,对飞行机器人的工作状态进行实施监视;0008 所述第一微控制器单元分别与所述通信模块、电源模块和双口RAM连接;用于整个系统的控制与任务调度,将获得的传感器数据存放入双口RAM的下行数据区;0009 所述第二微控制器单元分别与所述电源模块和双口RAM连接;用于实时解算当前飞行姿态,将实时解算的飞行机器人。
8、空中姿态数据存放如双口RAM的上行数据区;0010 所述双口RAM分别与所述电源模块、第一微控制器单元和第二微控制器单元;用于使通信的第一微控制器单元和第二微控制器单元可以按照各自的速度对数据进行处理和交换。0011 所述双口RAM包括邮箱Mail Box、上行数据区和下行数据区;所述邮箱Mail Box用于两个微控制器单元MCU在信息交互时产生中断;所述上行数据区用于存储第二微控制说 明 书CN 102759926 A2/3页4器单元实时解算的飞行机器人空中姿态数据;所述下行数据区用于存储第一微控制器单元所得到的传感器数据。0012 本发明的效果在于,采用双口RAM,解决了快速与慢速设备之间。
9、的矛盾,使得通信的两个微型控制器单元MCU可以按照各自的速度对数据进行处理和交换,保证系统的可靠性。附图说明0013 图1是本发明提供的一种基于双MCU实现的飞行机器人系统的硬件结构示意图;0014 图2是本发明提供的一种基于双MCU实现的飞行机器人系统的双口RAM的存储空间分配图;0015 图3是本发明提供的一种基于双MCU实现的飞行机器人系统的双口RAM驱动程序框图。具体实施方式0016 下面结合附图,对优选实施例作详细说明。应该强调的是下述说明仅仅是示例性的,而不是为了限制本发明的范围及其应用。0017 图1是本发明提供的一种基于双MCU实现的飞行机器人系统的硬件结构示意图。图1中基于双。
10、MCU实现的飞行机器人系统包括电源模块、通信模块、第一微控制器单元、第二微控制器单元和双口RAM;其中,所述电源模块分别与所述通信模块、第一微控制器单元、第二微控制器单元和双口RAM连接,用于为整个飞行机器人的正常工作提供能量;所述通信模块分别与所述电源模块和第一微控制器单元连接,用于将飞行机器人的实时状态信息发送至远端PC,对飞行机器人的工作状态进行实施监视;所述第一微控制器单元分别与所述通信模块、电源模块和双口RAM连接,用于整个系统的控制与任务调度,将获得的传感器数据存放入双口RAM的下行数据区;所述第二微控制器单元分别与所述电源模块和双口RAM连接,用于实时解算当前飞行姿态;所述双口R。
11、AM分别与所述电源模块、第一微控制器单元和第二微控制器单元,使得通信的两个微控制器单元MCU可以按照各自的速度对数据进行处理和交换。0018 图2是本发明提供的一种基于双MCU实现的飞行机器人系统的双口RAM的存储空间分配图。图2中,所述双口RAM包括邮箱Mail Box、上行数据区、下行数据区三个部分。邮箱Mail Box用于两个微控制器单元MCU在信息交互时产生中断,防止出现双口RAM中的传感器数据与已获得的姿态解算结果数据不是在同一软件运行周期内计算的问题。将剩余的RAM存储空间划分为上行数据区、下行数据区。上行数据区用于存储第二微控制器单元实时解算的飞行机器人空中姿态数据;下行数据区用。
12、于存储第一微控制器单元所得到的传感器数据。将双口RAM的存储空间进行人为划分可以避免两个微控制器单元MCU同时对双口RAM进行写操作。0019 图3是本发明提供的一种基于双MCU实现的飞行机器人系统的双口RAM驱动程序框图。图3中,在第一微控制器单元侧,系统在正常工作时,由第一微控制器单元将获得的传感器数据存放在双口RAM的下行数据区内;查看BUSY_R信号,判断第二微控制器单元是否在向上行数据区写入数据,若否,则读取经过解算获得的飞行姿态数据;此时,查说 明 书CN 102759926 A3/3页5看BUSY_L信号,判断第二微控制器单元是否在向下行数据区写入数据;若否,则操作邮箱Mail 。
13、Box产生中断,通知第二微控制器单元读取双口RAM中的传感器数据,进行空中姿态解算。0020 在第二微控制器单元侧,系统在正常工作时,由第二微控制器单元将通过解算获得的飞行机器人空中姿态数据存放在双口RAM的上行数据区内;查看BUSY_L信号,判断第一微控制器单元是否在向下行数据区写入数据,若否,则读取获得的传感器数据;此时,查看BUSY_R信号,判断第一微控制器单元是否在向上行数据区写入数据;若否,则操作邮箱Mail Box产生中断,通知第一微控制器单元读取双口RAM中的空中姿态数据。进入下一个循环周期。0021 以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。说 明 书CN 102759926 A1/3页6图1说 明 书 附 图CN 102759926 A2/3页7图2说 明 书 附 图CN 102759926 A3/3页8图3说 明 书 附 图CN 102759926 A。