带有矫正装置的自移动机器人及其矫正方法
【技术领域】
[0001] 本发明涉及一种带有矫正装置的自移动机器人及其矫正方法，属于小家电制造技 术领域。
【背景技术】
[0002] 现有的清洁机器人都是依靠履带或轮子在工作表面上移动，为提高清洁效率，机 器的行进轨迹一般都是规划成垂直于一条边的"弓"字形轨迹(如图7-图8所示)。
[0003] 目前，清洁机器人按照预设行进轨迹在工作表面移动，主要通过加速度传感器或 陀螺仪等方向传感器指示机器人的行走方向。将加速度传感器安装在清洁机器人上，并与 控制单元相连，通过加速度传感器检测清洁机器人的运动状态，同时将检测结果反馈给控 制单元，如果出现倾斜或偏离预定路线由控制单元发出指令进行相应的调整。然而在该方 案中，通过加速度传感器等电子元器件指示机器人的行走方向，而电子元器件长时间使用 会产生一定的累积误差，当加速度传感器存在误差时，加速度传感器的指示方向偏离原规 划路径的方向，从而清洁机器人不能沿预定规划的路线行走，对清洁机器人在工作表面上 的清洁效率存在较大的影响。
【发明内容】
[0004] 本发明所要解决的技术问题在于，针对现有技术的不足提供一种带有矫正装置的 自移动机器人及其矫正方法，通过边界检测传感器用于清洁机器人可以辅助方向传感器工 作，验证其检测结果的准确性，使得机器人始终能够以较小的误差水平或坚直移动。
[0005] 本发明所要解决的技术问题是通过如下技术方案实现的：
[0006] -种带有矫正装置的自移动机器人，包括：主机体，所述主机体设有控制单元、方 向传感器及行走单元，所述控制单元控制所述带有矫正装置的自移动机器人按照预设行走 模式行走，所述方向传感器用于指示机器人的行走方向，所述主机体上还设有边界检测传 感器，所述边界检测传感器与所述控制单元连接，根据边界检测传感器的感应信号，控制单 元判断方向传感器是否处于正确的工作状态，若方向传感器处于错误的工作状态则对其矫 正。
[0007] 优选地，所述边界检测传感器为至少两个。
[0008] 更好地，所述主机体的一端面两边分别设有至少一个边界检测传感器。
[0009] 更好地，所述端面为主机体的前端面或后端面
[0010] 所述边界检测传感器为接触式传感器或非接触式传感器。
[0011] 所述方向传感器为加速度传感器、陀螺仪或码盘。
[0012] 本发明还提供一种具有上述的带有矫正装置的自移动机器人的矫正方法，包括如 下步骤：
[0013] Sl:自移动机器人开机放在边框附近，根据边界检测传感器调整主机体至相对于 边框的位姿A，记录此时方向传感器的角度值9 ;
[0014] S2 :自移动机器人按照预设的行走模式行走，通过方向传感器指示主机体1的行 走方向；
[0015] S3 :当机器人行走至边框附近时，根据边界检测传感器调整机器至相对于边框的 位姿A，比较此时方向传感器的角度值(P'是否与CP相等，若f'不等于9，则矫正方向传感 器的角度值至9后，返回S2,否则直接返回S2。
[0016] 较常见的，所述边框为水平边框或坚直边框。
[0017] 为方便自移动机器人准确快速地找到相对于边框的位姿A，所述边界检测传感器 设置于主机体前端面两边，则位姿A为主机体前端与边框平行，当然，所述边界检测传感器 也可以设置于主机体后端面两边，则位姿A为主机体后端与边框平行。
[0018] 较佳的，所述边界检测传感器调整主机体至位姿A是通过设置于主机体1前端面 两边或后端面两边的边界检测传感器5感测到不同的边界信号或仅一边矫正装置检测到 边界信号。
[0019] 为提高自移动机器人的工作效率，所述预设行走模式规划为垂直于边框的"弓"字 形路线或往复直线路线。
[0020] 优选的，当机器人沿垂直于边框的"弓"字形模式或往复直线模式行走时，控制单 元根据方向传感器的反馈信号控制主机体在工作表面向边框的方向行走至边界，设置于主 机体前端面或后端面的边界检测传感器检测到主机体位姿倾斜时，矫正方向传感器的误 差。
[0021] 本发明带有矫正装置的自移动机器人结构简单，将边界检测传感器用于清洁机器 人可以辅助方向传感器工作，验证其检测结果的准确性，使得机器人始终能够以较小的误 差移动。
[0022] 下面结合附图和具体实施例对本发明的技术方案进行详细地说明。
【附图说明】
[0023] 图1为带有矫正装置的自移动机器人控制结构框图；
[0024] 图2为边界检测传感器设置于主机体前端两边的示意图；
[0025] 图3为边界检测传感器设置于主机体后端两边的示意图；
[0026] 图4为带有矫正装置的自移动机器人的矫正方法步骤图；
[0027] 图5为边界检测传感器设置于主机体前端两边的矫正过程示意图；
[0028] 图6为边界检测传感器设置于主机体后端两边的矫正过程示意图；
[0029] 图7为现有技术擦清洁机器人传统路径规划(水平方向）示意图；
[0030] 图8为现有技术擦清洁机器人传统路径规划(垂直方向）示意图。
【具体实施方式】
[0031] 图1为带有矫正装置的自移动机器人控制结构框图，图2为带有矫正装置的清洁 机器人实施例一的结构示意图，如图2并参考图1所示，一种带有矫正装置的自移动机器 人，包括：主机体1，所述主机体1设有控制单元2、方向传感器3及行走单元4,所述控制单 元2控制所述自移动机器人按照预设行走模式行走，如垂直于边框的"弓"字形行走或往复 直线行走，所述方向传感器3用于指示机器人的行走方向，所述方向传感器3可以为加速度 传感器、陀螺仪或码盘等。如图5所示，以图示箭头指示方向为自移动机器人的前向，在主 机体1的前端两边各设一边界检测传感器5,如图2所示，所述边界检测传感器5与所述控 制单元2连接，根据边界检测传感器5的感应信号，控制单元2判断方向传感器是否处于正 确的工作状态，若方向传感器3处于错误的工作状态则对其矫正，需要指出的是，在主机体 1的前端两边各设一边界检测传感器5仅为本实施例所列举的一种设置方式，所述边界检 测传感器同样可以设置于主机体1的左右两侧或主机体1的后端(如图3所示)，所述边界 检测传感器5的数量可以为任意一个以上的多个。
[0032] 请再次参考图5所示，具体的，下面以主机体1设有重力加速度传感器或陀螺仪 作为方向传感器3,主机体1前端左右两边分别设有边界检测传感器5为例进行解释说明。 当自移动机器人采用如图8所示的"弓"字形坚直行走，方向传感器3始终以重力方向为基 准方向，控制机器人重复坚直向上行走碰到边框转弯后再坚直向下行走的行走过程。当方 向传感器3正常工作时，机器人能准确识别坚直方向；但随着机器人的继续行走，方向传感 器3出现误差，则机器人行走的方向会偏离坚直方向，而机器人本身仍然以为沿坚直方向 行走，造成较大的行走结果偏差，降低机器人的清洁效率等。而当机器人向上或向下行走到 边框时，通过其前端的边界检测传感器5实时检测机器人的位姿来判断方向传感器3是否 处于正确的工作状态。如当机器人根据方向传感器3的指示，向上行走碰到边框时，机器人 前端左、右两边的边界检测传感器5同时感应到信号，则判断方向传感器3处于正确的工作 状态；若仅主机体1前端左边的边界检测传感器5或右边的边界检测传感器5感应到信号， 则判断机身倾斜，机器人偏离坚直方向，方向传感器3处于错误的工作状态，需对其进行矫 正。当然，若采用超声传感器或红外传感器时，若机器人行走到边框时，左、右边的边界检测 传感器5不会同时收到信号或者收到信号的强弱不同，则机器人判断出机身倾斜，方向传 感器3处于错误的工作状态，需对其进行矫正。
[0033] 上述实施中，玻璃边框本身是水平设置的。若玻璃边框是倾斜的，则当机器人向上 或向下行走，仅根据是否收到一个边界检测传感器5的感测信号或收到两个不同的边界检 测传感器5的感测信号，机器人无法判断机身是否偏离坚直，进而无法判断方向传感器3是 否存在误差，处于正确或错误的工作状态。此时，需要先将自移动机器人放在边框附近，根 据边界检测传感器