[发明专利]机器人基于加速计的仰角检测方法和被卡检测及脱卡方法

说明书

本发明涉及一种机器人基于加速计的仰角检测方法和被卡检测及脱卡方法。所述仰角检测方法通过利用加速计在竖直方向和前后方向检测到的加速度进行简化方差计算的方式，得出简化方差值，再通过判断所述简化方差值是否在第一预设方差范围内来确定机器人的仰角角度是否为零。如此可以有效避免机器人因为机体抖动等原因而造成加速计的检测数据出错，提高了机器人的数据检测的准确性和对自身状态判断的准确性。所述被卡检测方法，通过判断简化方差值在一定时间内是否处于某一参考数值范围来确定机器人是否被卡，准确性比较高。所述脱卡方法针对机器人被卡的不同情况，通过控制不同的驱动轮进行不同的动作，以实现机器人的高效脱卡。

技术领域

本发明涉及机器人领域，具体涉及一种机器人基于加速计的仰角检测方法和被卡检测及脱卡方法。

背景技术

在实际家庭环境中，大多数家庭都有立地电风扇、门槛和吧台座椅等等，有些办公地方还有一些凳脚是U型的座椅，该座椅接触地面的凳脚是U型的不锈钢管，管的横截面为扁圆形状，这些物体都具有一定的坡度。由于机器人的机体抖动等原因，机器人的加速计检测到的数据会漂移不定，有时机器人会因为加速计在竖直方向上检测到的加速度而误判机器人爬上了某一物体，而实际上，机器人依然处于水平面上。此外，扫地机器人在进行清扫工作时，容易被立地电风扇底座、门槛、吧台座椅的底座或者U型凳脚卡住，导致机器人出现打滑或者被卡住无法移动的问题，从而影响了机器人构建地图的准确性，导航准确性也因此大大降低。目前，很多机器人都无法识别是否被立地电风扇底座、门槛、吧台座椅的底座或者U型凳脚卡住的问题，有的机器人在这方面可以做一些改善，但是需要额外增加视觉或者激光等传感器的检测，导致机器人的成本增加，不利于推广应用。

发明内容

本发明提供了一种机器人基于加速计的仰角检测方法和被卡检测及脱卡方法，可以准确地判断机器人是否处于水平面上，且在不需要增加硬件成本的基础上准确检测出机器人是否被卡。本发明的具体技术方案如下：

所述机器人基于加速计的仰角检测方法，包括如下步骤：基于加速计在竖直方向和前后方向检测到的加速度，确定机器人的运动分量；每隔第一预定时间段采集一次所述运动分量，将第二预定时间段内所采集到的所述运动分量进行简化的方差计算，确定简化方差值；判断所述简化方差值是否在第一预设方差范围内，如果是，则确定所述机器人的仰角角度为零，否则，确定所述机器人的仰角角度不为零。

进一步地，所述基于加速计在竖直方向和前后方向检测到的加速度，确定机器人的运动分量的步骤，具体包括：确定所述加速计在竖直方向检测到的加速度为Rz；确定所述加速计在前后方向检测到的加速度为Ry；确定机器人的运动分量为R1，R1=Ry*Ry+Rz*Rz。

进一步地，所述每隔第一预定时间段采集一次所述运动分量，将第二预定时间段内所采集到的所述运动分量进行简化的方差计算，确定简化方差值的步骤，具体包括：每隔第一预定时间段采集一次所述运动分量，并将所述运动分量进行开平方，得到开方运动分量，再将所述开方运动分量除以第一简化倍数，得到简化运动分量；将第二预定时间段内所采集到的多个所述简化运动分量进行平方累积和，得到平方累积和运动分量；将第二预定时间段内所采集到的多个所述简化运动分量进行累积和，得到累积和运动分量；将所述累积和运动分量的平方与所述平方累积和运动分量的差值除以第二简化倍数，得到简化方差值。

所述机器人基于加速计的被卡检测方法，包括如下步骤：基于上述的机器人基于加速计的仰角检测方法，确定所述机器人的仰角角度不为零后，判断第三预定时间段内的所述简化方差值是否都在第二预设方差范围内；当所述简化方差值都在第二预设方差范围内，且相邻的两个所述简化方差值的差值都小于第一预定方差值，则确定机器人被卡在与所述第二预设方差范围相对应的物体上；当所述简化方差值不在第二预设方差范围内，则判断第三预定时间段内的所述简化方差值是否都在第三预设方差范围内；当所述简化方差值都在第三预设方差范围内，且相邻的两个所述简化方差值的差值都小于所述第一预定方差值，则确定机器人被卡在与所述第三预设方差范围相对应的物体上，否则，确定机器人没有被卡。