器Dl记录灭火机器人实时的加速度、速度和位置信号并送给控制器，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向前运动。通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置，灭火机器人实现在设置停车点停车，FPGA重新调整灭火机器人六个电机的PffM波输出，首先禁止前后轮的四路PWM波控制信号工作，同时使能中驱的两轮PWM波输出，使中驱直流无刷电机X和直流无刷电机Y运动方向相反，灭火机器人原地在加速计传感器Al、陀螺仪Gl和方向传感器Dl的控制下实现精确的原地180度转向，然后灭火机器人沿着原先相反的方向运动；
如果在坐标(X，Y)时的方向为北，则更新其坐标为(X，Y)，新坐标方向为南；如果在坐标(X，Y)时的方向为东，则更新其坐标为(XI，Y)，新坐标方向为西；如果在坐标(X，Y)时的方向为南，则更新其坐标为(X，Y)，新坐标方向为北；如果在坐标(X，Y)时的方向为西，则更新其坐标为(X，Y)，新坐标方向为东；
10)在灭火机器人沿着当前方向向前运动过程中如果有挡墙进入前方的运动范围，并且此时超声波传感器S2和S3判断左边有挡墙，而超声波传感器S4、S5判断右方没有挡墙时，灭火机器人将存储此时坐标(X，Y)，然后灭火机器人将按照图7的曲线行走；
在右转弯时，FPGA首先把行走直线很短的距离R90_Leading按照控制器不同搜寻速度和加速度要求生成灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的位置、速度和加速度指令值，FPGA再结合电流传感器C1-C4和光电编码器的反馈生成控制直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PffM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R向前运动，在灭火机器人沿着当前房间格向前探索过程中，超声波传感器S2、S3会对左挡墙进行判断，并记录储存当前搜寻房间挡墙信息，灭火机器人根据前进方向左挡墙的房间信息进入单左墙导航模式，然后再结合设定的左挡墙导航阀值，加速度计传感器Al、陀螺仪Gl和方向传感器Dl记录灭火机器人实时的加速度、速度和位置信号并送给控制器，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要运行的新的位置、速度和加速度指令值，FPGA再结合电流传感器C1-C6、光电编码器、加速计传感器Al、陀螺仪Gl和方向传感器Dl的反馈，微调直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R、直流无刷电机U和直流无刷电机W的PffM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R、直流无刷电机U和直流无刷电机W向前运动。通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置；
当到达既定目标时，传感器参考值R90_FrOntWallRef开始工作，防止外界干扰开始做误差补偿，误差补偿结束后，STM32F407通过FPGA释放前后四驱的四个直流无刷电机，通过中驱的两个直流无刷电机进行转弯，控制器开始调整直流无刷电机X和直流无刷电机Y速度使其完成弧度ARC的运动曲线，FPGA首先把弧度ARC按照控制器不同搜寻速度和加速度要求转化为灭火机器人直流无刷电机X和直流无刷电机Y要运行的位置、速度和加速度指令值，FPGA再结合电流传感器Cl、C2和光电编码器的反馈生成控制电机X和电机Y的PffM控制信号，PWM波控制信号通过驱动桥放大后推动灭火机器人完成转弯搜寻，在灭火机器人转弯搜寻过程中，超声波传感器S2、S3、S4、S5无法为系统提供位置参考，系统依靠方向传感器Dl进行位置修正。在灭火机器人快速搜寻转弯过程中方向传感器Dl实时记录其瞬时角度，控制器通过与设定位置的角度对比，当灭火机器人快速搜寻脱离了设定位置时，在新的采样周期内，FPGA把偏差大小转化为灭火机器人直流无刷电机X和直流无刷电机Y要运行的新的位置、速度和加速度指令值，FPGA再结合电流传感器Cl、C2、光电编码器、加速计传感器Al、陀螺仪Gl和方向传感器Dl的反馈，微调直流无刷电机X和直流无刷电机Y的PffM控制信号，两轴伺服系统开始进行实时补偿来调整灭火机器人的姿态，使其完成弧度ARC;
当到达既定目标后，系统依靠超声波传感器S2、S3开始导航，FPGA把直线行走很短的距离R90_Passing按照控制器不同搜寻速度和加速度要求生成灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的位置、速度和加速度指令值，FPGA再结合电流传感器C1-C4和光电编码器的反馈生成控制直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PffM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R向前运动，在灭火机器人沿着当前房间格向前探索过程中，超声波传感器S2、S3会对左挡墙进行判断，并记录储存当前搜寻房间挡墙信息，灭火机器人根据前进方向左挡墙的房间信息进入单左墙导航模式，然后再结合设定的左挡墙导航阀值，加速度计传感器Al、陀螺仪Gl和方向传感器Dl记录灭火机器人实时的加速度、速度和位置信号并送给控制器，FPGA实时记录储存灭火机器人的瞬时加速度、速度和位置信息，当灭火机器人快速探索脱离了设定中心位置时，微处理器根据离开中心位置的偏差由FPGA转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的新的位置、速度和加速度指令值，FPGA再结合电流传感器C1-C4、光电编码器、加速计传感器Al、陀螺仪Gl和方向传感器Dl的反馈，微调直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R的PffM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R向前运动，通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置；如果灭火机器人在校正位置阶段出现失速或者房间地面灰尘较多的情况，FPGA会调节直流电机M加大灭火机器人与地面的摩擦并使能前中后驱的六轮PWM波控制信号，控制器开启直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R、直流无刷电机U和直流无刷电机W，系统进入六轮驱动状态，FPGA根据时间和速度要求，把剩余的距离D转化为灭火机器人直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R要运行的新的位置、速度和加速度指令值，FPGA再结合电流传感器C1-C6、光电编码器、加速计传感器Al、陀螺仪Gl和方向传感器Dl的反馈，微调直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R、直流无刷电机U和直流无刷电机W的PffM控制信号，控制信号经驱动桥放大后驱动直流无刷电机X、直流无刷电机Y、直流无刷电机Z、直流无刷电机R、直流无刷电机U和直流无刷电机W向前运动，通过此方式可以精确调整灭火机器人的姿态，使其重新回到设定中心位置；当到达既定目标后完成整个右转弯的轨迹曲线运动，然后控制其开始更新其坐标和方向；
如果在坐标(X，Y)时的方向为北，则更新其坐标为(X+1，Y)，新坐标方向为东；如果在坐标(X，Y)时的方向为东，则更新其坐标为(X，Y-1)，新坐标方向为南；如果在坐标(X，Y)时的方向为南，则更新其坐标为(Χ_1，Υ)，新坐标方向为西；如果在坐标(X，Y)时的方向为西，则更新其坐标为(X，Υ+1)，新坐标方向为北；
光电传感器S7开始工作，对新坐标下的光源进行判断，如果光电传感器S7捕捉到信号将通知控制器发现目标，控制器会让光电传感器S7禁止工作2秒工作，2秒后重新开启光电传感器S7，如果再次捕捉到光电信号，控制器会开启携带的干冰容器的电磁阀，开始对蜡烛进行喷洒干冰直至光源消失；如果光电传感器S7没有捕捉到新坐标下的光源，灭火机器人将离开目前房间格，将继续搜寻并更新其坐标；
11)在灭火机器人沿着当前方向向前运动过程中如果有挡墙进入前方的运动范围，并且此时左右的超声波传感器S2和S3判断左边无挡墙，而超声波传感器S4、S5判断右方有挡墙时，灭火机器人将存储此时坐标(X，Y)，然后灭火机器人将按照图8的曲线行走；
在左转弯时，控制器控制电机行走规律与右转类似，当通过三段法到达既定目标后完成整个左转弯的轨迹曲线运动，控制器按照图6的设置开始更新其坐标和方向。
[0034]如果在坐标(X，Y)时的方向为北，则更新其坐标为(Χ-1，Y)，新坐标方向为西；如果在坐标(X，Y)时的方向为东，则更新其坐标为(X，Υ+1)，新坐标