，并响应各种中断，实现数据信号的实时存储。双核控制器把STM32F407从复杂的工作当中解脱出来，实现部分的信号处理算法和MC58113的控制逻辑，并响应中断，实现数据通信和存储实时信号。
[0041]为达上述目的，本发明采取以下技术方案，为了提高运算速度，保证两轮灭火机器人系统的稳定性和可靠性，本发明在基于STM32F407的控制器中引入精密运动控制专用芯片MC58113，形成基于STM32F407+专用运动控制芯片的全新双核控制器，从双核控制器引入真空吸附技术，同时引入加速度传感器和陀螺仪进行二次姿态校正。此控制器充分考虑电池在这个系统的作用，把控制系统中工作量最大的六轴伺服系统交给MC58113处理，充分发挥MC58113作为伺服控制器的优点和STM32F407数据处理速度相对较快的特点，把STM32F407从复杂的三轴伺服控制中解脱出来，实现人机界面、房间读取、房间存储、坐标定位等简单功能。
[0042]参照图3，具体实施步骤是:
对于本文设计的STM32F407+MC58113双核四轮灭火机器人控制器，在电源打开状态下，灭火机器人先进入自锁状态。灭火机器人通过超声波传感器S1、S6判断前方运动环境，实际导航环境被转化为控制参数传输给STM32F407，STM32F407把这些环境参数转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈生成控制直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PWM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R向前运动，加速度计Al、陀螺仪Gl和光电编码器实时把测得的信号反馈给STM32F407，由微处理器二次校正灭火机器人的姿态。灭火机器人在运动过程中，控制器根据灭火机器人运动速度自动通过电机M调节真空装置对地面的吸附能力，增加有效摩擦，防止灭火机器人快速行走打滑，并实时储存房间信息。当控制器发现火源后，图像采集系统开启。控制器在图像采集帮助下，自动调整灭火器喷嘴与火源的角度，同时升降电机E自动调节灭火器的高度，然后自动开启干冰灭火器电磁阀，通过喷洒干冰灭火，灭火完毕后STM32F407立即调出灭火机器人已经储存的房间信息，通过洪水算法找出返程最短路径，并开启加速模式迅速回到起点等待一下条寻求火源命令。
[0043]参照图4、图5，图6、图7、图8，其具体的功能实现如下:
O为了能够驱动两轮灭火机器人运动，本控制系统引入了两片MC58113，其中一片MC58113处理四轴直流无刷电机的伺服控制，另外一片MC58113处理两轴直流电机的控制，两片MC58113通过I/O 口与STM32F407进入实时通讯，MC58113处理电机方式均是通过STM32F407对其初始化过程完成的，由STM32F407控制其开通和关断。
[0044]2)打开电源瞬间，STM32F407会对电池电压进行检测，如果低压的话，STM32F407将通过一片MC58113封锁直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PWM波控制信号，电机不能启动，同时电压传感器Vl将工作，并发出报警信号。如果系统电压正常，控制器首先通过另外一片MC58113开启真空抽吸电机M，通过抽吸装置先对微型真空吸盘抽吸，使真空吸盘对地面具有一定的吸附力，控制器并实时检测，如果地面不干净，系统会自动调节电机M加大真空吸盘对地面的吸附力。
[0045]3)在灭火机器人未接到探索命令之前，它一般会在起点坐标(0，0)等待控制器发出的探索命令，一旦接到任务后，会沿着起点开始为了寻找火源进行全宫探索。
[0046]4)灭火机器人放在起点坐标(0，0)，一般情况下，灭火机器人按照图6中北的方向(计算机编程代码为O)放置，接到任务后其前方的传感器S1、S6和会对前方的环境进行判断，确定有没有挡墙进入运动范围，如存在挡墙将向STM32F407发出存储命令，STM32F407会对中断做第一时间响应，然后禁止后驱两路PWM波控制信号工作，使能中驱的两路PWM波控制信号工作，STM32F407通过调整MC58113的输入控制直流无刷电机X正转，直流无刷电机Y反转，灭火机器人在加速度传感器Al、陀螺仪Gl的控制下向右旋转90度，灭火机器人首先沿着X轴正向(东的方向，计算机编程代码为2)搜寻火源。
[0047]5)在灭火机器人运动过程中，装在直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R上的光电编码器会输出其位置信号A和位置信号B，光电编码器的位置信号A脉冲和B脉冲逻辑状态每变化一次，MC58113的位置寄存器会根据电机X和电机Y的运行方向加I或者是减I ;
6)在灭火机器人运动过程中，装在直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R上的光电编码器的位置信号A脉冲和B脉冲和Z脉冲同时为低电平时，就产生一个INDEX信号给MC58113寄存器，记录电机的绝对位置，然后换算成灭火机器人在房间中的具体位置。
[0048]7)为了能够实现灭火机器人准确的坐标计算功能，灭火机器人左右的传感器S2、S3和S4、S5会时刻对运动方向左右的房间挡墙和柱子进行探测，如果S2、S3或者S4、S5发现传感器信号发生了跃变，则说明灭火机器人进入了从有房间挡墙到无房间挡墙(或者是从无房间挡墙到有房间挡墙)状态的变化，STM32F407会根据灭火机器人当前运行状态精确补偿，彻底消除灭火机器人在复杂房间中探寻火源时已经累计的误差。
[0049]8)在灭火机器人沿着任何一个方向向前运动，在任何一个方格的中心如果确定没有挡墙进入前方的运动范围，则灭火机器人将存储其坐标(X，Y)，并把向前运动一格的位置参数送给STM32F407。STM32F407把向前一格参数转化为灭火机器人直流无刷电机X和直流无刷电机Y要运行的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈生成控制直流无刷电机X和直流无刷电机Y的PWM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X和直流无刷电机Y向前运动。在灭火机器人沿着当前房间格向前探索过程中，传感器S2、S3和S4、S5会对左右的挡墙进行判断，并记录储存当前搜寻房间挡墙信息，灭火机器人根据前进方向左右挡墙的房间信息进入单墙导航模式或者是双墙导航模式，然后再结合设定的左右挡墙导航阀值，加速度计Al、陀螺仪Gl记录灭火机器人实时的加速度、速度信号并送给控制器，控制器分别通过积分得到瞬时角度，控制器记录灭火机器人的瞬时加速度、速度和位置信息，当灭火机器人快速探索脱离了设定中心位置时，微处理器根据离开中心位置的偏差由STM32F407转化为灭火机器人直流无刷电机X和直流无刷电机Y要运行的新的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈，微调直流无刷电机X和直流无刷电机Y的PWM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X和直流无刷电机Y向前运动。通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置；如果灭火机器人搜寻火源过程中出现失速或者房间地面灰尘较多的情况，STM32F407会调节M加大灭火机器人与地面的摩擦并使能后驱的两轮PffM波控制信号，控制器开启直流无刷电机Z和直流无刷电机R，系统进入四轮驱动状态，STM32F407根据时间和速度要求，把剩余的距离D转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的新的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈，生成直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PWM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R向前运动。灭火机器人在四驱状态下依旧按照原有的导航模式前进，加速度计Al、陀螺仪Gl记录灭火机器人实时的加速度、速度信号并送给控制器，控制器分别通过积分得到瞬时角度，控制器记录灭火机器人的瞬时加速度、速度和位置信息，当灭火机器人四轮探索脱离了设定中心位置时，微处理器根据离开中心位置的偏差由STM32F407转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的新的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈，微调直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PffM控制信号，控制信号经驱动桥放大后驱动电机X和电机Y向前运动。通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置；当灭火机器人在加速度计Al的控制下运动一格距离到达新地址时，微处理器将更新其坐标信息。
[0050]如果在坐标(X，Y)时的方向为北，在更新其坐标为(X，Y+1)，新坐标方向依旧为北；如果在坐标(X，Y)时的方向为东，在更新其坐标为(Χ+1，Y)，新坐标方向依旧为东；如果在坐标(Χ，Υ)时的方向为南，在更新其坐标为(X，Υ-1)，新坐标方向依旧为南；如果在坐标(X，Y)时的方向为西，在更新其坐标为(Χ-1，Y)，新坐标方向依旧为西；
9)在灭火机器人沿着当前方向向前运动过程中如果传感器SI和S6判断前方有挡墙进入运动范围，并且此时传感器S2、S3、S4、S5分别判断左右都有挡墙时，灭火机器人将存储此时坐标(X，Y)，根据传感器SI和S6的反馈计算出向前运动停车的位置参数YS1，由STM32F407根据探索控制器速度和加速度把向前停车距离参数转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z和直流无刷电机R要运行的位置、速度和加速度指令值，STM32F407然后与MC58113通讯，MC58113再结合电机光电编码器的反馈生成控制直流无刷电机X、直流无刷电机Y、直流无刷电机Z和直流无刷电机R的PffM