[发明专利]一种扫地机器人被困的检测方法

权利要求书

1.种扫地机器人被困的检测方法，其特征在于：所述智能移动机器人包括

用于检测设备在单位时间内所转动的角度的陀螺仪模块；

用于检测设备在单位时间内左车轮转动里程以及右车轮转动里程的边轮里程计；

用于检测设备在单位时间内实际移动的里程以及实际转动的角度的光流模组；

用于收集陀螺仪模块、边轮里程计、光流模组所检测到的数据，并对该数据进行处理的处理模块；

其中所述扫地机器人被困的检测方法具体包括以下步骤：

步骤1，处理模块根据陀螺仪模块在单位时间内所检测的数据，并计算出设备所转动的角度，并定义为陀螺仪转动角度参数值θ；

步骤2，处理模块根据光流模组在与步骤1相同的时间内所检测的数据，并计算出设备所走的里程，并定义为光流里程参数值；同时计算出设备所转动的角度，并定义为光流转动角度参数值β；

步骤3，处理模块根据边轮里程计在与步骤1相同的时间内所检测的数据，计算出设备所走的里程，并定义为边轮里程参数值；同时计算出设备所转动的角度，并定义为边轮转动角度参数值α；

步骤4，处理模块根据光流里程参数值与边轮里程参数值是否符合处理模块中预设的函数关系，且陀螺仪转动角度参数值θ、光流转动角度参数值β、边轮转动角度参数值α之间的差值是否大于处理模块设定的阈值，从而判断是否进入被困状态,机器人便可以采取一些脱困测措施。

2.据权利要求1所述的一种扫地机器人被困的检测方法，其特征在于：所述步骤1的具体步骤为：在处理模块设定的单位时间内，陀螺仪模块将时间起始所处的角度以及时间结束时所处的角度发送至处理模块，处理模块并计算出设备转动的角度，并定义为陀螺仪转动角度参数值θ。

3.据权利要求1所述的一种扫地机器人被困的检测方法，其特征在于：所述步骤3的具体步骤为：边轮里程计将设备在与步骤1相同的时间内左车轮的左轮转动里程与右车轮的右轮转动里程发送至处理模块，所述处理模块根据左轮转动里程与右轮转动里程计算出边轮里程参数值，同时处理模块根据左轮转动里程与右轮转动里程的差值计算出边轮转动角度参数值α。

4.据权利要求1所述的一种扫地机器人被困的检测方法，其特征在于：所述步骤1、步骤2、步骤3为同时进行。