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