一种具有支持多种网络通讯的消防灭火机器人的制作方法
专利名称：一种具有支持多种网络通讯的消防灭火机器人的制作方法
技术领域：
本发明涉及机械及网络通讯技术领域，具体地说是一种具有支持多种网络通讯的消防灭火机器人。
背景技术：
随着国民经济的迅速发展，各类工业厂区、高层建筑、地铁站的通讯设施逐渐增多，实现了工业的自动化生产以及国民的数字化生活，但同时也给消防工作带来了困扰和危机，在地铁站和高层建筑内将面临自组网的通讯系统无法覆盖整个区域的问题，在大范围消防灭火作业时自组网的通讯系统又由于功率限制的难题面临通讯网络无法覆盖整个消防灭火作业范围。自组网的通讯系统时，只能实现灭火作业点和现场指挥人员的通讯，远在指挥中心的领导无法直接了解现场的灭火作业情况，影响了其对灾害程度的判断。使用公共网的通讯设备在无基站网络覆盖的地下车库以及特殊地区无法进行通讯，从而影响了消防灭火作业。消防灭火机器人的直线行走性能主要靠两台电机同步控制机械行走机构来完成，由于机械结构的制造和安装精度等问题，造成两台直流无刷电机的负载不相同，以及两台无刷直流电机的动态特性无法达到完全相同，将会造成消防灭火机器人在起步和遇到障碍时偏离直线行走的正确路线。
发明内容
本发明为克服现有技术的不足，在消防灭火机器人的基础上增加自动纠偏模块及网络通讯模块，并将履带进行改良，能够进行一定高度的攀爬作业，综合多种功能一体的消防灭火机器人，增加用途范围。为实现上述目的，设计一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二 MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一 RF数据通讯模块，所述的第二 MCU设有USARTO及USARTl端口，其特征在于底盘上设有安装支架，安装支架上设有消防炮；所述的底盘内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接收模块设有两个信号输出端，一端连接底盘内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端；所述的嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下(1)系统初始化；
(2)USARTO接收中断、USARTl接收中断及按键扫描；
(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处
理；
(4)任务调度优先级处理；
(5)2个无刷电机驱动器底层驱动；
(6)提取测试速度参数及速度补偿参数进行速度PID算法；
(7)PWM输出。所述的底盘两侧分别设有履带装置，履带装置的前端与地面呈45°，履带装置的后端与地面呈6°。所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CCD视频采集A及CCD视频采集B的输出端分别连接2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU ；另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的MCU。。所述的嵌设软件的第二 MCU软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描;
(3)按键处理；
(4)AT指令数据包封装；
(5)USARTO发送中断处理及USARTl发送中断处理。所述的嵌设软件的RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描及模拟串口扫描；
(3)按键处理及模拟串口处理扫描；
(4)数据包封装；
(5)载波侦听；
(6)RF发送。
所述的嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)模拟串口扫描；
(3)模拟串口处理扫描；
(4)RF接收；
(5)模拟串口数据发送。本发明同现有技术相比，增设3G及WIFI网络通讯模块，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率。利用电机脉冲控制，提升消防灭火机器人的直线行走能力，通过采集电机的反馈信号对电机的执行量进行修正，达到两台电机在不同负载和动态特性的情况下达到行程的同步。增设一种行走履带，能够进行一定高度的攀爬作业，而且对于崎岖不平的道路同样没有问题，大大增大了灭火机器人的适用范围。
图1为本发明结构示意图。图2为控制系统结构示意图。图3为遥控发射模块结构示意图。图4为遥控接收模块结构示意图。图5为履带受力分析图。图6为MCU数据调度和行走纠偏软件流程图。
图7为第二 MCU软件流程图。图8为RF数据通讯模块软件流程图。图9为另一 RF数据通讯模块软件流程图。参加图1，1为底盘，2为安装支架，3为消防炮。
具体实施例方式下面根据附图对本发明做进一步的说明。如图1所示，底盘1上设有安装支架2，安装支架2上设有消防炮3 ；底盘1两侧分别设有履带装置，履带装置的前端与地面呈6°，履带装置的后端与地面呈45°。如图2所示，所述的底盘1内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接
6收模块设有两个信号输出端，一端连接底盘1内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端。如图3所示，所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。如图4所示，所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CCD视频采集A及CCD视频采集B的输出端分别连接2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU;另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的MCU。如图5 所示，Pn = Mk /rk Pf = Pn · f式中一障碍物的反作用力；
Pf_障碍物的反摩擦力；Mk —驱动轮扭矩；! k—驱动轮半径；Pna _地对支撑点的反力；PfA _地面对支点的摩擦力。
对A点的力矩平衡方程式为:PfA和Pna对A的力矩为0，即Pf · I2 + .h = G · I1；很明显Pf · I2 + Pn · h ^ G . I1，所以行走履带就能跨越障碍物。嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下
(1)系统初始化；
(2)USARTO接收中断、USARTl接收中断及按键扫描；
(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处
理；
(4)任务调度优先级处理；
(5)2个无刷电机驱动器底层驱动；
(6)提取测试速度参数及速度补偿参数进行速度PID算法；
(7)PWM输出。其中，速度PID算法是由HALL扫描后进行速度及行程的算法，行程算法后进行行程PID算法，最后得出测试速度参数及速度补偿参数。嵌设软件的第二 MCU软件流程进行如下处理步骤(1)系统初始化；
(2)按键扫描;
(3)按键处理；
(4)AT指令数据包封装；
(5)USARTO发送中断处理及USARTl发送中断处理。嵌设软件的RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描及模拟串口扫描；
(3)按键处理及模拟串口处理扫描；
(4)数据包封装；
(5)载波侦听；
(6)RF发送。嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)模拟串口扫描；
(3)模拟串口处理扫描；
(4)RF接收；
(5)模拟串口数据发送。工作时，遥控发射模块内部的地址编码器和频率编码器将系统编码输入给嵌设软件的RF数据通讯模块，使嵌设软件的RF数据通讯模块存储一组唯一的编码，按键模块同时将按键数据输入至嵌设软件的第二 MCU以及通过数据转换模块传输给嵌设软件的RF数据通讯模块，嵌设软件的第二MCU将按键数据进行处理后输入至3G网络数据通讯模块和WIFI网络数据通讯模块。嵌设软件的RF数据通讯模块通过433Mhz的无线通讯接口发送数据至遥控接收模块内部的嵌设软件的RF数据通讯模块；3G网络数据通讯模块通过3G无线接口发送数据至遥控接收模块内部的3G网络数据通讯模块；WIFI网络数据通讯模块通过WIFI无线通讯接口发送数据至遥控接收模块内部的WIFI网络数据通讯模块。遥控接收模块内部的另一地址编码器和另一频率编码器将系统编码输入给嵌设软件的另一 RF数据通讯模块，嵌设软件的另一 RF数据通讯模块将接收到的数据进行编码校验后将数据通过另一数据转换模块输入至嵌设软件的MCU，另一 3G网络数据通讯模块将接收到的数据输入至嵌设软件的MCU，另一 WIFI网络数据通讯模块将接收到的数据输入至嵌设软件的MCU。CXD视频采集A和CXD视频采集B将视频信号同时传输入至2. 4G视频发射模块以及通过H. 264视频数据压缩模块将压缩后的数据输入至另一 3G网络视频通讯模块。遥控发射模块内部的2. 4G视频接收模块将接收到的视频数据输入至显示器，3G网络视频通讯模块通过视频数据解压模块将视频数据输入至显示器。3G网卡设备将视频数据输入至台式计算机、笔记本计算机以及3G手机。在工作时，左右两侧的直流无刷电机驱动左右两侧的主驱动轮系运动，主动主驱动轮系带动履带装置运动，直流无刷电机不间断地将HALL反馈脉冲信号输送给嵌设软件的MCU，嵌设软件的MCU将收到的脉冲转换为行程数据及速度数据，然后做出行程补偿，将行程补偿通过PID算法后得出的结果通过PID输出量由信号输送至无刷电机驱动器，无刷电机驱动器将PID输出量转换为脉冲信号输送至直流无刷电机，直流无刷电机收到脉冲信号时改变其运作状态，从而改变主驱动轮系的速度，直至履带的速度，达到两台电机在不同负载和动态特性的情况下达到行程的同步。 改进原有灭火机器人近距离操控的模式，增设3G及WIFI网络，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率；增设自动纠偏模块，使灭火机器人能够时时进行速度及行程的补偿，做到不偏离目标的效果；改进的履带结构，使灭火机器人进行一定高度的攀爬作业，而且对于崎岖不平的道路同样没有问题，大大增大了灭火机器人的适用范围，设计出一种多功能的灭火机器人，无论何时、何地、何种状况的火灾，都能够进行灭火工作，大大提高了灭火作业的效率。
权利要求
1.一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二 MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一 RF数据通讯模块，所述的第二 MCU设有USARTO及USARTl端口，其特征在于底盘(1)上设有安装支架(2)，安装支架(2)上设有消防炮(3);所述的底盘(1)内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接收模块设有两个信号输出端，一端连接底盘(1)内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端；所述的嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下(1)系统初始化；(2)USARTO接收中断、USARTl接收中断及按键扫描；(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处理；(4)任务调度优先级处理；(5)2个无刷电机驱动器底层驱动；(6)提取测试速度参数及速度补偿参数进行速度PID算法；(7)PWM输出。
2.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的底盘(1)两侧分别设有履带装置，履带装置的前端与地面呈45°，履带装置的后端与地面呈6°。
3.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。
4.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CXD视频采集A及CXD视频采集B的输出端分别连接.2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU ；另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的M⑶。
5.根据权利要求1或3所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的第二 MCU软件流程进行如下处理步骤(1)系统初始化；(2)按键扫描;(3)按键处理；(4)AT指令数据包封装；(5)USARTO发送中断处理及USARTl发送中断处理。
6.根据权利要求3所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的RF数据通讯模块软件流程进行如下处理步骤(1)系统初始化；(2)按键扫描及模拟串口扫描；(3)按键处理及模拟串口处理扫描；(4)数据包封装；(5)载波侦听；(6)RF发送。
7.根据权利要求4所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤(1)系统初始化；(2)模拟串口扫描；(3)模拟串口处理扫描；(4)RF接收；(5)模拟串口数据发送。
全文摘要
本发明涉及机械及网络通讯技术领域，具体地说是一种具有支持多种网络通讯的消防灭火机器人。一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一RF数据通讯模块，所述的第二MCU设有USART0及USART1端口。同现有技术相比，增设3G及WIFI网络通讯模块，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率。
文档编号A62C27/00GK102553112SQ20121003276
公开日2012年7月11日 申请日期2012年2月14日 优先权日2012年2月14日
发明者孙财平 申请人:上海务进消防安全设备有限公司, 上海芜津消防设备有限公司
技术领域：
本发明涉及机械及网络通讯技术领域，具体地说是一种具有支持多种网络通讯的消防灭火机器人。
背景技术：
随着国民经济的迅速发展，各类工业厂区、高层建筑、地铁站的通讯设施逐渐增多，实现了工业的自动化生产以及国民的数字化生活，但同时也给消防工作带来了困扰和危机，在地铁站和高层建筑内将面临自组网的通讯系统无法覆盖整个区域的问题，在大范围消防灭火作业时自组网的通讯系统又由于功率限制的难题面临通讯网络无法覆盖整个消防灭火作业范围。自组网的通讯系统时，只能实现灭火作业点和现场指挥人员的通讯，远在指挥中心的领导无法直接了解现场的灭火作业情况，影响了其对灾害程度的判断。使用公共网的通讯设备在无基站网络覆盖的地下车库以及特殊地区无法进行通讯，从而影响了消防灭火作业。消防灭火机器人的直线行走性能主要靠两台电机同步控制机械行走机构来完成，由于机械结构的制造和安装精度等问题，造成两台直流无刷电机的负载不相同，以及两台无刷直流电机的动态特性无法达到完全相同，将会造成消防灭火机器人在起步和遇到障碍时偏离直线行走的正确路线。
发明内容
本发明为克服现有技术的不足，在消防灭火机器人的基础上增加自动纠偏模块及网络通讯模块，并将履带进行改良，能够进行一定高度的攀爬作业，综合多种功能一体的消防灭火机器人，增加用途范围。为实现上述目的，设计一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二 MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一 RF数据通讯模块，所述的第二 MCU设有USARTO及USARTl端口，其特征在于底盘上设有安装支架，安装支架上设有消防炮；所述的底盘内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接收模块设有两个信号输出端，一端连接底盘内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端；所述的嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下(1)系统初始化；
(2)USARTO接收中断、USARTl接收中断及按键扫描；
(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处
理；
(4)任务调度优先级处理；
(5)2个无刷电机驱动器底层驱动；
(6)提取测试速度参数及速度补偿参数进行速度PID算法；
(7)PWM输出。所述的底盘两侧分别设有履带装置，履带装置的前端与地面呈45°，履带装置的后端与地面呈6°。所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CCD视频采集A及CCD视频采集B的输出端分别连接2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU ；另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的MCU。。所述的嵌设软件的第二 MCU软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描;
(3)按键处理；
(4)AT指令数据包封装；
(5)USARTO发送中断处理及USARTl发送中断处理。所述的嵌设软件的RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描及模拟串口扫描；
(3)按键处理及模拟串口处理扫描；
(4)数据包封装；
(5)载波侦听；
(6)RF发送。
所述的嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)模拟串口扫描；
(3)模拟串口处理扫描；
(4)RF接收；
(5)模拟串口数据发送。本发明同现有技术相比，增设3G及WIFI网络通讯模块，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率。利用电机脉冲控制，提升消防灭火机器人的直线行走能力，通过采集电机的反馈信号对电机的执行量进行修正，达到两台电机在不同负载和动态特性的情况下达到行程的同步。增设一种行走履带，能够进行一定高度的攀爬作业，而且对于崎岖不平的道路同样没有问题，大大增大了灭火机器人的适用范围。
图1为本发明结构示意图。图2为控制系统结构示意图。图3为遥控发射模块结构示意图。图4为遥控接收模块结构示意图。图5为履带受力分析图。图6为MCU数据调度和行走纠偏软件流程图。
图7为第二 MCU软件流程图。图8为RF数据通讯模块软件流程图。图9为另一 RF数据通讯模块软件流程图。参加图1，1为底盘，2为安装支架，3为消防炮。
具体实施例方式下面根据附图对本发明做进一步的说明。如图1所示，底盘1上设有安装支架2，安装支架2上设有消防炮3 ；底盘1两侧分别设有履带装置，履带装置的前端与地面呈6°，履带装置的后端与地面呈45°。如图2所示，所述的底盘1内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接
6收模块设有两个信号输出端，一端连接底盘1内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端。如图3所示，所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。如图4所示，所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CCD视频采集A及CCD视频采集B的输出端分别连接2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU;另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的MCU。如图5 所示，Pn = Mk /rk Pf = Pn · f式中一障碍物的反作用力；
Pf_障碍物的反摩擦力；Mk —驱动轮扭矩；! k—驱动轮半径；Pna _地对支撑点的反力；PfA _地面对支点的摩擦力。
对A点的力矩平衡方程式为:PfA和Pna对A的力矩为0，即Pf · I2 + .h = G · I1；很明显Pf · I2 + Pn · h ^ G . I1，所以行走履带就能跨越障碍物。嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下
(1)系统初始化；
(2)USARTO接收中断、USARTl接收中断及按键扫描；
(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处
理；
(4)任务调度优先级处理；
(5)2个无刷电机驱动器底层驱动；
(6)提取测试速度参数及速度补偿参数进行速度PID算法；
(7)PWM输出。其中，速度PID算法是由HALL扫描后进行速度及行程的算法，行程算法后进行行程PID算法，最后得出测试速度参数及速度补偿参数。嵌设软件的第二 MCU软件流程进行如下处理步骤(1)系统初始化；
(2)按键扫描;
(3)按键处理；
(4)AT指令数据包封装；
(5)USARTO发送中断处理及USARTl发送中断处理。嵌设软件的RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)按键扫描及模拟串口扫描；
(3)按键处理及模拟串口处理扫描；
(4)数据包封装；
(5)载波侦听；
(6)RF发送。嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤
(1)系统初始化；
(2)模拟串口扫描；
(3)模拟串口处理扫描；
(4)RF接收；
(5)模拟串口数据发送。工作时，遥控发射模块内部的地址编码器和频率编码器将系统编码输入给嵌设软件的RF数据通讯模块，使嵌设软件的RF数据通讯模块存储一组唯一的编码，按键模块同时将按键数据输入至嵌设软件的第二 MCU以及通过数据转换模块传输给嵌设软件的RF数据通讯模块，嵌设软件的第二MCU将按键数据进行处理后输入至3G网络数据通讯模块和WIFI网络数据通讯模块。嵌设软件的RF数据通讯模块通过433Mhz的无线通讯接口发送数据至遥控接收模块内部的嵌设软件的RF数据通讯模块；3G网络数据通讯模块通过3G无线接口发送数据至遥控接收模块内部的3G网络数据通讯模块；WIFI网络数据通讯模块通过WIFI无线通讯接口发送数据至遥控接收模块内部的WIFI网络数据通讯模块。遥控接收模块内部的另一地址编码器和另一频率编码器将系统编码输入给嵌设软件的另一 RF数据通讯模块，嵌设软件的另一 RF数据通讯模块将接收到的数据进行编码校验后将数据通过另一数据转换模块输入至嵌设软件的MCU，另一 3G网络数据通讯模块将接收到的数据输入至嵌设软件的MCU，另一 WIFI网络数据通讯模块将接收到的数据输入至嵌设软件的MCU。CXD视频采集A和CXD视频采集B将视频信号同时传输入至2. 4G视频发射模块以及通过H. 264视频数据压缩模块将压缩后的数据输入至另一 3G网络视频通讯模块。遥控发射模块内部的2. 4G视频接收模块将接收到的视频数据输入至显示器，3G网络视频通讯模块通过视频数据解压模块将视频数据输入至显示器。3G网卡设备将视频数据输入至台式计算机、笔记本计算机以及3G手机。在工作时，左右两侧的直流无刷电机驱动左右两侧的主驱动轮系运动，主动主驱动轮系带动履带装置运动，直流无刷电机不间断地将HALL反馈脉冲信号输送给嵌设软件的MCU，嵌设软件的MCU将收到的脉冲转换为行程数据及速度数据，然后做出行程补偿，将行程补偿通过PID算法后得出的结果通过PID输出量由信号输送至无刷电机驱动器，无刷电机驱动器将PID输出量转换为脉冲信号输送至直流无刷电机，直流无刷电机收到脉冲信号时改变其运作状态，从而改变主驱动轮系的速度，直至履带的速度，达到两台电机在不同负载和动态特性的情况下达到行程的同步。 改进原有灭火机器人近距离操控的模式，增设3G及WIFI网络，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率；增设自动纠偏模块，使灭火机器人能够时时进行速度及行程的补偿，做到不偏离目标的效果；改进的履带结构，使灭火机器人进行一定高度的攀爬作业，而且对于崎岖不平的道路同样没有问题，大大增大了灭火机器人的适用范围，设计出一种多功能的灭火机器人，无论何时、何地、何种状况的火灾，都能够进行灭火工作，大大提高了灭火作业的效率。
权利要求
1.一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二 MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一 RF数据通讯模块，所述的第二 MCU设有USARTO及USARTl端口，其特征在于底盘(1)上设有安装支架(2)，安装支架(2)上设有消防炮(3);所述的底盘(1)内部设有嵌设软件的MCU、自动纠偏功能模块、网络通讯模块，嵌设软件的MCU的一端连接自动纠偏功能模块，嵌设软件的MCU的另一端连接网络通讯模块；所述的自动纠偏功能模块设有2个无刷电机驱动器、2个直流无刷电机，嵌设软件的MCU设有2个信号输出端及2个信号输入端，2个信号输出端分别连接2个无刷电机驱动器的信号输入端，2个无刷电机驱动器的输出端分别连接其一侧的直流无刷电机的信号输入端，2个直流无刷电机的信号输出端分别连接嵌设软件的MCU的2个信号输入端；所述的网络通讯模块包括遥控发射模块、遥控接收模块、声光报警模块，遥控发射模块内设有嵌设有软件的第二 MCU，遥控发射模块的信号输出端连接遥控接收模块的信号输入端，遥控接收模块设有两个信号输出端，一端连接底盘(1)内部的嵌设软件的MCU的信号输入端，另一端连接声光报警模块的信号输入端；所述的嵌设软件的MCU数据调度和行走纠偏软件流程步骤如下(1)系统初始化；(2)USARTO接收中断、USARTl接收中断及按键扫描；(3)对应USARTO接收中断的数据包解析、对应USARTl接收中断的数据包解析及按键处理；(4)任务调度优先级处理；(5)2个无刷电机驱动器底层驱动；(6)提取测试速度参数及速度补偿参数进行速度PID算法；(7)PWM输出。
2.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的底盘(1)两侧分别设有履带装置，履带装置的前端与地面呈45°，履带装置的后端与地面呈6°。
3.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的遥控发射模块采用按键模块设有2个输出端，一端连接数据转换模块的输入端，数据转换模块的输出端连接嵌设软件的RF数据通讯模块的输入端，嵌设软件的RF数据通讯模块的另一输入端连接地址编码器及频率编码器的输出端，遥控发射模块内部的嵌设软件的第二 MCU设有三个端口，一端连接按键模块的另一输出端，另两端采用USARTO及USARTl分别双向连接3G网络数据通讯模块及WIFI网络数据通讯模块；遥控发射模块采用显示器的输入端连接2. 4G视频接收模块的输出端及3G网络视频通讯模块通过视频数据解压模块的输出端；遥控发射模块采用3G网卡设备的输出端分别连接台式计算机、笔记本计算机、3G智能手机的输入端。
4.根据权利要求1所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的遥控接收模块采用另一地址编码器及另一频率编码器的输出端连接嵌设软件的另一 RF数据通讯模块的输入端，嵌设软件的另一 RF数据通讯模块的输出端连接另一数据转换模块的输入端，另一数据转换模块设有两个输出端，另一数据转换模块的一个输出端连接2. 4G视频发射模块的输入端；CXD视频采集A及CXD视频采集B的输出端分别连接.2. 4G视频发射模块的另一输入端及H. 264视频数据压缩模块的输入端，H. 264视频数据压缩模块的输出端连接另一 3G网络视频通讯模块的输入端；另一数据转换模块的另一输出端连接嵌设软件的MCU ；另一 3G网络数据通讯模块及另一 WIFI网络数据通讯模块分别双向连接嵌设软件的M⑶。
5.根据权利要求1或3所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的第二 MCU软件流程进行如下处理步骤(1)系统初始化；(2)按键扫描;(3)按键处理；(4)AT指令数据包封装；(5)USARTO发送中断处理及USARTl发送中断处理。
6.根据权利要求3所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的RF数据通讯模块软件流程进行如下处理步骤(1)系统初始化；(2)按键扫描及模拟串口扫描；(3)按键处理及模拟串口处理扫描；(4)数据包封装；(5)载波侦听；(6)RF发送。
7.根据权利要求4所述的一种具有支持多种网络通讯的消防灭火机器人，其特征在于所述的嵌设软件的另一 RF数据通讯模块软件流程进行如下处理步骤(1)系统初始化；(2)模拟串口扫描；(3)模拟串口处理扫描；(4)RF接收；(5)模拟串口数据发送。
全文摘要
本发明涉及机械及网络通讯技术领域，具体地说是一种具有支持多种网络通讯的消防灭火机器人。一种具有支持多种网络通讯的消防灭火机器人，包括底盘、消防炮、安装支架、嵌设软件的MCU、嵌设软件的第二MCU、嵌设软件的RF数据通讯模块、嵌设软件的另一RF数据通讯模块，所述的第二MCU设有USART0及USART1端口。同现有技术相比，增设3G及WIFI网络通讯模块，使得远在指挥中心的领导可以直接了解现场的灭火作业情况，对火灾的情况能够时时进行监控，及时做出正确的判断，提高灭火工作的效率。
文档编号A62C27/00GK102553112SQ20121003276
公开日2012年7月11日 申请日期2012年2月14日 优先权日2012年2月14日
发明者孙财平 申请人:上海务进消防安全设备有限公司, 上海芜津消防设备有限公司
最新回复(0)