一种基于陀螺仪的扫地机器人及姿态检测与脱困方法技术

本发明专利技术提供一种基于陀螺仪的扫地机器人姿态检测与脱困方法，包括以下步骤，S1：对扫地机器人在正常运行过程中的相对角度值A以及绝对角度值B范围进行预先设定；绝对角度值B为扫地机器人在特定时间的角度值与参考角度的差值；相对角度A为扫地机在固定时间内竖直方向的角度的变化值；参考角度C为扫地机在地面上运行时固定时间内竖直方向的角度在小范转围内时读值的平均值，S2：判定相对角度值A和绝对角度值B是否达到预设值；若达到预设值，则判定扫地机器人处于倾斜状态，实际应用过程中，可以较为精确的对扫地机器人的具体倾斜状态、左右转动情况等进行感测，并采用后续的加速倒退、左右摆动等脱困步骤进行脱困，使用体验度高。

【技术实现步骤摘要】
一种基于陀螺仪的扫地机器人及姿态检测与脱困方法[
]本专利技术涉及扫地机器人产品
，尤其涉及一种结构设计合理，使用效果突出的基于陀螺仪的扫地机器人及姿态检测与脱困方法。[
技术介绍
]近些年，扫地机器人产品得到了快速的推广和应用，为人们的日常生活提供了诸多的便利，其灵活度高，且可以按照预设的轨迹对室内地面进行较为清洁的清扫，深受使用者的喜爱。然而，目前的扫地机器人产品依然存在较多的不足，如功能不够丰富，无法满足人们的某一些特殊的使用需求，智能化程度不高等等，制约着产品的更好的推广和使用，尤其是在运行过程中的姿态检测与脱困技术方面，存在较大的不足。基于此，本领域的技术人员进行了大量的研发和实验，并取得了较好的成绩。[
技术实现思路
]为克服现有技术所存在的问题，本专利技术提供一种结构设计合理，使用效果突出的基于陀螺仪的扫地机器人及姿态检测与脱困方法。本专利技术解决技术问题的方案是提供一种基于陀螺仪的扫地机器人姿态检测与脱困方法，包括以下步骤，S1：对扫地机器人在正常运行过程中的相对角度值A以及绝对角度值B范围进行预先设定；绝对角度值B为扫地机器人在特定时间的角度值与参考角度的差值；相本文档来自技高网...

【技术保护点】
1.一种基于陀螺仪的扫地机器人姿态检测与脱困方法，其特征在于：包括以下步骤，S1：对扫地机器人在正常运行过程中的相对角度值A以及绝对角度值B范围进行预先设定；绝对角度值B为扫地机器人在特定时间的角度值与参考角度的差值；相对角度值A为扫地机在固定时间内竖直方向的角度的变化值；参考角度值C为扫地机在地面上运行时固定时间内竖直方向的角度在小范转围内时读值的平均值；S2：判定相对角度值A和绝对角度值B是否达到预设值；若达到预设值，则判定扫地机器人处于倾斜状态；进一步对扫地机器人的姿态进行检测，并进行脱困处理；S3：控制扫地机器人后退预设行程，若感测出扫地机器人的绝对角度值B未减少，则判定该扫地机器人被...

【技术特征摘要】
1.一种基于陀螺仪的扫地机器人姿态检测与脱困方法，其特征在于：包括以下步骤，S1：对扫地机器人在正常运行过程中的相对角度值A以及绝对角度值B范围进行预先设定；绝对角度值B为扫地机器人在特定时间的角度值与参考角度的差值；相对角度值A为扫地机在固定时间内竖直方向的角度的变化值；参考角度值C为扫地机在地面上运行时固定时间内竖直方向的角度在小范转围内时读值的平均值；S2：判定相对角度值A和绝对角度值B是否达到预设值；若达到预设值，则判定扫地机器人处于倾斜状态；进一步对扫地机器人的姿态进行检测，并进行脱困处理；S3：控制扫地机器人后退预设行程，若感测出扫地机器人的绝对角度值B未减少，则判定该扫地机器人被困，进入步骤S4；若绝对角度值B减少，则判定该扫地机器人的倾斜状态产生变化；S4：脱困处理；通过获取扫地机器人左右转动时的角速度值和时间值，计算得出扫地机器人的转动角度，当光栅计算的角度与陀螺仪计算的角度差值达到设定值时，则定义为扫地机器人左右不能摆动，进入步骤S5；若未达到预定值，则判定扫地机器人可以左右摆动；S5：控制扫地机器人加力后退预定距离，然后再左右转动判断是否可以摆动；若不能摆动，再左右加力摆动直至脱困；当检测到左右能摆动时，则控制左右扭动后退直至脱困；S6：扫地机器人姿态检测与脱困处理完成。2.一种基于陀螺仪的扫地机器人，其特征在于：包括机器人主机体以及设置于所述机器人主机体内部的电源、控制电路板、除尘箱、UV杀菌灯、陀螺仪组件、用于进行数据信息存储的数据存储器、风机组件、安设于机器人主机体外侧用于接收外部红外遥控信号的红外传感器、用于与外部移动终端进行通讯连接的无线通讯传输单元、储水水箱以及安设于机器人主机体下部的边刷组件以及左右驱动轮组件；所述机器人主机体内部还设置有温湿度传感器、报警器以及用于提高设备内部散热性能的散热风扇；该除尘箱、UV杀菌灯、陀螺仪组...

【专利技术属性】
技术研发人员：左海明，谢涛，
申请(专利权)人：深圳市云鼠科技开发有限公司，
类型：发明
国别省市：广东,44