CN107263509B - 公共清扫机器人路径规划系统及控制方法 - Google Patents
公共清扫机器人路径规划系统及控制方法 Download PDFInfo
- Publication number
- CN107263509B CN107263509B CN201610210202.8A CN201610210202A CN107263509B CN 107263509 B CN107263509 B CN 107263509B CN 201610210202 A CN201610210202 A CN 201610210202A CN 107263509 B CN107263509 B CN 107263509B
- Authority
- CN
- China
- Prior art keywords
- laser
- walking
- cleaning robot
- laser emitter
- public cleaning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000004140 cleaning Methods 0.000 title claims abstract description 190
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000001514 detection method Methods 0.000 claims abstract description 6
- 238000006243 chemical reaction Methods 0.000 claims description 31
- 238000011065 in-situ storage Methods 0.000 claims description 24
- 230000001960 triggered effect Effects 0.000 claims description 11
- 230000002457 bidirectional effect Effects 0.000 claims description 3
- 238000010408 sweeping Methods 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 230000007547 defect Effects 0.000 description 2
- 239000011521 glass Substances 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种公共清扫机器人路径规划系统及控制方法，其中公共清扫机器人路径规划系统包含公共清扫机器人和激光发射器组，所述公共清扫机器人包括机体，本体上设有控制单元、行走单元、行走激光接收器和位置变换接收器，所述激光发射器组包括：设置在公共清扫机器人第一作业区域横向边缘的第一行走激光发射器组和第二行走激光发射器组，所述第一行走激光发射器组与第二行走激光发射器组相对设置，并且每一个第一行走激光发射器与每一个第二行走激光发射器交错设置；其中，所述第一行走激光发射器组中两端的第一激光发射器分别设有信号检测装置和控制信号发射装置；在每一个作业区域内远离第一行走激光发射器组设置的位置激光发射器上设有触碰开关。
Description
技术领域
本发明涉及机器人领域，尤其涉及一种公共清扫机器人路径规划系统及控制方法。
背景技术
目前市场上的智能清扫机器人体积较小，主要是针对家庭环境进行清扫，并且一般采用“弓”字形的清扫模式进行清扫，若在较大区域进行清扫，由于面积较大、行走路线较长，机器人在直线行走的过程中有可能偏离行走路线，并且在较大区域采用单“弓”字形行走方式有可能存在清扫不彻底的缺陷。
发明内容
本发明所要解决的技术问题在于，针对现有技术的不足提供一种公共清扫机器人路径规划系统及控制方法，将较大区域分成若干小区域，并采用双“弓”字形行走方式，达到全面清扫、清扫彻底的效果，并且采用线激光的激光束信号，既满足远距离导向的要求，能够在较远的距离控制公共清扫机器人以较小的直线误差直线运动，提高工作效率。
本发明所要解决的技术问题是通过如下技术方案实现的：
本发明提供一种公共清扫机器人路径规划系统，包含公共清扫机器人和激光发射器组，所述公共清扫机器人包括机体，本体上设有控制单元、行走单元、行走激光接收器和位置变换接收器，所述控制单元根据所述行走激光接收器和所述位置变换接收器接收到的信号控制行走单元动作，带动所述机体移动；所述激光发射器组包括：设置在公共清扫机器人第一作业区域横向边缘的第一行走激光发射器组和第二行走激光发射器组，所述第一行走激光发射器组与第二行走激光发射器组相对设置，所述第一行走激光发射器组包括n个第一行走激光发射器，所述第二行走激光发射器组包括n-1个第二行走激光发射器，并且每一个第一行走激光发射器与每一个第二行走激光发射器交错设置；其中，每一个第二行走激光发射器为双向激光发射器；所述激光发射器组还包括多个位置激光发射器，每一个作业区域设置两个位置激光发射器，并且位于公共清扫机器人每一个作业区域纵向的边缘；其中，所述第一行走激光发射器组中两端的第一激光发射器分别设有信号检测装置和控制信号发射装置，当所述第一激光发射器被触发时，所述控制信号发射装置按照每一个作业区域的顺序，控制每一个作业区域内，远离第一行走激光发射器组设置的位置激光发射器打开；在每一个作业区域内远离第一行走激光发射器组设置的位置激光发射器上设有触碰开关，控制与第一行走激光发射器组相近位置上的激光发射器打开；公共清扫机器人在作业区域内按照激光发射器组发射的激光信号行走作业。
更好地，所述行走激光接收器根据所述第一行走激光发射器组和第二行走激光发射器组，引导公共清扫机器人在工作区域内直线行走；所述位置变换接收器引导公共清扫机器人转向。
更好地，每一个第一行走激光发射器与每一个第二行走激光发射器之间的横向距离为公共清扫机器人机体的一个身位宽度。
更好地，所述激光发射器组中的每一个激光发射器，为线激光束发射器，其发射的激光信号为线激光束信号。
更好地，每一个第一行走激光发射器和每一个位置激光发射器为单向激光发射器。
更好地，所述行走激光接收器设置在沿公共清扫机器人行走方向机体中心线上；所述位置变换接收器的数量为两个，并且以该行走激光接收器为中心线对称设置。
更好地，所述行走激光接收器和位置变换接收器为全向激光接收器。
本发明还提供一种如上述的公共清扫机器人路径规划系统的控制方法，该控制方法包括如下步骤：
S1：设置在公共清扫机器人第一作业区域边缘的第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发射激光信号；
S2：行走激光接收器和位置变换接收器接收到激光信号，按照激光信号的引导，公共清扫机器人的控制单元通过控制其行走单元，在第一作业区域内行走作业；
S3：公共清扫机器人按照第一行走激光发射器组中的最后一个激光发射器发射的激光信号，行走出第一作业区域并走向第二作业区域；
S4：设置在第二作业区域边缘的位置激光发射器开启并发射激光信号，公共清扫机器人接收第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发出的激光信号，并根据该激光信号在第二作业区域内行走作业。
更好地，在S1中，当公共清扫机器人位于第一行走激光发射器组中的第一个行走激光发射器位置时，在该第一个行走激光发射器上设置的信号检测装置被触发，并向控制信号发射装置发出信号，所述控制信号发射装置发出控制信号使远离第一行走激光发射器组设置的位置激光发射器打开。
更好地，S2具体包括：
S21：公共清扫机器人以第一作业区域的第一边缘为起始位置，按照第一行走激光发射器组所发出的激光信号的引导，沿第一作业区域的第二边缘，在纵向上朝第三边缘直线行走；
S22：公共清扫机器人运动到第一作业区域的第三边缘，所述位置变化接收器接收到远离第一行走激光发射器组设置的位置激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
其中，当公共清扫机器人第一次走到远离第一行走激光发射器组设置的位置激光发射器时，触发设置在该位置激光发射器上的触碰开关，使设置在第一行走激光发射器组相近位置上的激光发射器打开；
S23：公共清扫机器人沿第三边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第二行走激光发射器组发出的激光信号后，停止并原地转向90°；
S24：公共清扫机器人按照第二行走激光发射器组发出的激光信号的引导，在纵向上朝第一边缘直线行走；
S25：公共清扫机器人运动到第一作业区域的第一边缘，所述位置变化接收器接收到设置在第一行走激光发射器组相近位置上的激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
S26：公共清扫机器人沿第一边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第一行走激光发射器组发出的激光信号后，停止并原地转向90°，返回S21；
S27：公共清扫机器人按照激光引导完成第一作业区域内的行走作业。
更好地，在S3中，当公共清扫机器人位于第一行走激光发射器组中的最后一个行走激光发射器位置时，在该行走激光发射器上设置的信号检测装置被触发，并向控制信号发射装置发出信号，所述控制信号发射装置发出控制信号，使第二工作区域内远离第一行走激光发射器组设置的位置激光发射器打开，同时关闭第一工作区域内的位置激光发射器。
更好地，S4具体包括：
S41：公共清扫机器人以第二作业区域的第一边缘为起始位置，按照第一行走激光发射器组所发出的激光信号的引导，沿第二作业区域的第二边缘，在纵向上朝第三边缘直线行走；
S42：公共清扫机器人运动到第二作业区域的第三边缘，所述位置变化接收器接收到远离第一行走激光发射器组设置的位置激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
其中，当公共清扫机器人第一次走到远离第一行走激光发射器组设置的位置激光发射器时，触发设置在该位置激光发射器上的触碰开关，使设置在第一行走激光发射器组相近位置上的激光发射器打开；
S43：公共清扫机器人沿第三边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第二行走激光发射器组发出的激光信号后，停止并原地转向90°；
S44：公共清扫机器人按照第二行走激光发射器组发出的激光信号的引导，在纵向上朝第一边缘直线行走；
S45：公共清扫机器人运动到第二作业区域的第一边缘，所述位置变化接收器接收到设置在第一行走激光发射器组相近位置上的激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
S46：公共清扫机器人沿第一边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第一行走激光发射器组发出的激光信号后，停止并原地转向90°，返回S21；
S47：公共清扫机器人按照激光引导完成第二作业区域内的行走作业。
更好地，所述S21和S24以及S41和S44中的直线行走，具体包括：当所述行走激光接收器接收到激光信号，则控制单元判定公共清扫机器人位于所述直线路径；否则，控制单元判定公共清扫机器人偏离所述直线路径，控制单元以公共清扫机器人的行走方向为基准进行向左或向右的转向行走调整，直到所述行走激光接收器重新接收到激光信号。
本发明的公共清扫机器人路径规划系统及控制方法，将较大区域分成若干小区域，并采用双“弓”字形行走方式，达到全面清扫、清扫彻底的效果，并且采用线激光的激光束信号，既满足远距离导向的要求，能够在较远的距离控制公共清扫机器人以较小的直线误差直线运动，提高工作效率。
下面结合附图和具体实施例对本发明的技术方案进行详细地说明。
附图说明
图1为本发明公共清扫机器人路径规划系统中公共清扫机器人逻辑结构框图；
图2为本发明公共清扫机器人路径规划系统中公共清扫机器人俯视图；
图3为本发明公共清扫机器人路径规划系统中公共清扫机器人侧视图；
图4为本发明公共清扫机器人路径规划系统中公共清扫机器人在每一个区域内的运动路径示意图；
图5为本发明控制方法步骤流程图；
图6为本发明公共清扫机器人运动过程图。
具体实施方式
图1为本发明公共清扫机器人路径规划系统中公共清扫机器人逻辑结构框图，图2为本发明公共清扫机器人路径规划系统中公共清扫机器人俯视图，图3为本发明公共清扫机器人路径规划系统中公共清扫机器人侧视图，如图1并参考图2-图3所示，本发明公共清扫机器人路径规划系统，包含公共清扫机器人和激光发射器组，所述公共清扫机器人包括机体1，本体1上设有控制单元3、行走单元2、行走激光接收器4和位置变换接收器5，所述行走激光接收器4设置在沿公共清扫机器人行走方向A机体1中心线上；所述位置变换接收器5的数量为两个，并且以该行走激光接收器4为中心线对称设置，并且为了达到更好的接收效果所述行走激光接收器4和位置变换接收器5为全向激光接收器；公共清扫机器人上设置的控制单元3根据所述行走激光接收器4和所述位置变换接收器5接收到的信号控制行走单元2动作，带动所述机体1移动。
图6为本发明公共清扫机器人运动过程图，如图6所示，所述激光发射器组包括：设置在公共清扫机器人第一作业区域横向边缘的第一行走激光发射器组6和第二行走激光发射器组7，所述第一行走激光发射器组6与第二行走激光发射器组7相对设置；为了使公共清扫机器人能够顺利地从第一工作区域移动到第二工作区域，所述第一行走激光发射器6组包括n个第一行走激光发射器，所述第二行走激光发射器7组包括n-1个第二行走激光发射器；每一个第一行走激光发射器与每一个第二行走激光发射器交错设置，并且每一个第一行走激光发射器与每一个第二行走激光发射器之间的横向距离为公共清扫机器人机体1的一个身位宽度。
所述激光发射器组还包括多个位置激光发射器8，每一个作业区域设置两个位置激光发射器8，并且位于公共清扫机器人每一个作业区域纵向的边缘；其中，所述第一行走激光发射器组6中两端的第一激光发射器分别设有信号检测装置和控制信号发射装置(图中未示出)，当所述第一激光发射器被触发时，所述控制信号发射装置按照每一个作业区域的顺序，控制每一个作业区域内，远离第一行走激光发射器组设置的位置激光发射器8打开；
在每一个作业区域内远离第一行走激光发射器组6设置的位置激光发射器8上设有触碰开关81，控制与第一行走激光发射器组6相近位置上的激光发射器8打开；公共清扫机器人在作业区域内按照激光发射器组发射的激光信号行走作业。在公共清扫机器人工作中，所述行走激光接收器4根据所述第一行走激光发射器组6和第二行走激光发射器组7，引导公共清扫机器人在工作区域内直线行走；所述位置变换接收器5引导公共清扫机器人转向。
为了使接收效果更好，所述激光发射器组中的每一个激光发射器，为线激光束发射器，其发射的激光信号为线激光束信号，并且每一个第一行走激光发射器和每一个位置激光发射器8为单向激光发射器，每一个第二行走激光发射器为双向激光发射器。
图4为本发明公共清扫机器人路径规划系统中公共清扫机器人在每一个区域内的运动路径示意图，图5为本发明控制方法步骤流程图，如图4所示，公共清扫机器人的运动路径为类“弓”字形状。公共清扫机器人的具体运动过程结合图5和图6所示，整体来说，第一行走激光发射器组6、第二行走激光发射器组7和多个位置激光发射器8将作业区域分成若干个小工作区域，公共清扫机器人按照激光信号的引导，在小工作区域完成行走作业后，自动移动到下一个小工作区域作业。
具体来说，包括如下步骤：
S1：设置在公共清扫机器人第一作业区域边缘的第一行走激光发射器组6、第二行走激光发射器组7和位置激光发射器8发射激光信号；
具体地说，当公共清扫机器人位于第一行走激光发射器组6中的第一个行走激光发射器位置时，在该第一个行走激光发射器上设置的信号检测装置61被触发，并向控制信号发射装置(图中未示出)发出信号，所述控制信号发射装置发出控制信号使远离第一行走激光发射器组6设置的位置激光发射器8打开。
S2：行走激光接收器4和位置变换接收器5接收到激光信号，按照激光信号的引导，公共清扫机器人的控制单元3通过控制其行走单元2，在第一作业区域Y内行走作业；
S3：公共清扫机器人按照第一行走激光发射器组6中的最后一个激光发射器发射的激光信号，行走出第一作业区域Y并走向第二作业区域Z；
具体地说，当公共清扫机器人位于第一行走激光发射器组6中的最后一个行走激光发射器位置时，在该行走激光发射器上设置的信号检测装置62被触发，并向控制信号发射装置(图中未示出)发出信号，所述控制信号发射装置发出控制信号，使第二工作区域Z内远离第一行走激光发射器组设置的位置激光发射器8打开，同时关闭第一工作区域Y内的位置激光发射器8。
S4：设置在第二作业区域Z边缘的位置激光发射器8开启并发射激光信号，公共清扫机器人接收第一行走激光发射器组6、第二行走激光发射器组7和位置激光发射器8发出的激光信号，并根据该激光信号在第二作业区域Z内行走作业。
其中，S2具体包括如下步骤：
S21：公共清扫机器人以第一作业区域Y的第一边缘M为起始位置，按照第一行走激光发射器组6所发出的激光信号的引导，沿第一作业区域Y的第二边缘N，在纵向上朝第三边缘P直线行走；
S22：公共清扫机器人运动到第一作业区域Y的第三边缘P，所述位置变化接收器5接收到远离第一行走激光发射器组设置的位置激光发射器8发出的激光信号后，公共清扫机器人停止并原地转向90°；
在这里需要说明的，当公共清扫机器人第一次走到远离第一行走激光发射器组6设置的位置激光发射器8时，触发设置在该位置激光发射器8上的触碰开关81，使设置在第一行走激光发射器组6相近位置上的激光发射器8打开；
S23：公共清扫机器人沿第三边缘P在横向上对应平移，直到公共清扫机器人上的位置变换接收器5接收到第二行走激光发射器组7发出的激光信号后，停止并原地转向90°；
S24：公共清扫机器人按照第二行走激光发射器组7发出的激光信号的引导，在纵向上朝第一边缘M直线行走；
S25：公共清扫机器人运动到第一作业区域Y的第一边缘M，所述位置变化接收器5接收到设置在第一行走激光发射器组6相近位置上的激光发射器8发出的激光信号后，公共清扫机器人停止并原地转向90°；
S26：公共清扫机器人沿第一边缘M在横向上对应平移，直到公共清扫机器人上的位置变换接收器5接收到第一行走激光发射器6组发出的激光信号后，停止并原地转向90°，返回S21；
S27：公共清扫机器人按照激光引导完成第一作业区域Y内的行走作业。
S4具体包括：
S41：公共清扫机器人以第二作业区域Z的第一边缘A为起始位置，按照第一行走激光发射器组6所发出的激光信号的引导，沿第二作业区域Z的第二边缘B，在纵向上朝第三边缘C直线行走；
S42：公共清扫机器人运动到第二作业区域Z的第三边缘C，所述位置变化接收器5接收到远离第一行走激光发射器组设置的位置激光发射器8发出的激光信号后，公共清扫机器人停止并原地转向90°；
需要说明的是，当公共清扫机器人第一次走到远离第一行走激光发射器组设置的位置激光发射器8时，触发设置在该位置激光发射器8上的触碰开关81，使设置在第一行走激光发射器组6相近位置上的激光发射器8打开；
S43：公共清扫机器人沿第三边缘C在横向上对应平移，直到公共清扫机器人上的位置变换接收器5接收到第二行走激光发射器组7发出的激光信号后，停止并原地转向90°；
S44：公共清扫机器人按照第二行走激光发射器组7发出的激光信号的引导，在纵向上朝第一边缘A直线行走；
S45：公共清扫机器人运动到第二作业区域Z的第一边缘A，所述位置变化接收器5接收到设置在第一行走激光发射器组6相近位置上的激光发射器8发出的激光信号后，公共清扫机器人停止并原地转向90°；
S46：公共清扫机器人沿第一边缘A在横向上对应平移，直到公共清扫机器人上的位置变换接收器5接收到第一行走激光发射器组6发出的激光信号后，停止并原地转向90°，返回S21；
S47：公共清扫机器人按照激光引导完成第二作业区域Z内的行走作业。
另外，为了达到更好的直线行走效果，在所述S21和S24以及S41和S44中的直线行走，具体包括：
当所述行走激光接收器4接收到激光信号，则控制单元3判定公共清扫机器人位于所述直线路径；
否则，控制单元3判定公共清扫机器人偏离所述直线路径，控制单元3以公共清扫机器人的行走方向为基准进行向左或向右的转向行走调整，直到所述行走激光接收器4重新接收到激光信号。
这里需要说明的是，公共清扫机器人为清扫机器人，也可以是擦玻璃机器人，公共清扫机器人重复上述方法步骤，继续按照“弓”字形清扫每一个被划分出的小工作区域，在这里不再赘述；另外，在本发明中的公共清扫机器人通过激光信号规划路径，还可以通过红外线或者超声波信号规划路径。
另外，按照本发明上述控制方法步骤，公共清扫机器人除了在小工作区域内按照“弓”字形行走外，在大区域内也是按照“弓”字形进行清扫工作，即采用双“弓”字行行走模式，这样的工作方式大大减小了卫生死角问题，清洁更彻底，更省时；另外，本发明公共清扫机器人路径规划系统采用线激光的激光束信号，既满足远距离导向的要求，能够在较远的距离控制公共清扫机器人以较小的直线误差直线运动，提高工作效率。
Claims (9)
1.一种公共清扫机器人路径规划系统，包括公共清扫机器人和激光发射器组，其特征在于，所述公共清扫机器人包括机体，本体上设有控制单元、行走单元、行走激光接收器和位置变换接收器，所述控制单元根据所述行走激光接收器和所述位置变换接收器接收到的信号控制行走单元动作，带动所述机体移动；
所述激光发射器组包括：
设置在公共清扫机器人第一作业区域横向边缘的第一行走激光发射器组和第二行走激光发射器组，所述第一行走激光发射器组与第二行走激光发射器组相对设置，所述第一行走激光发射器组包括n个第一行走激光发射器，所述第二行走激光发射器组包括n-1个第二行走激光发射器，并且每一个第一行走激光发射器与每一个第二行走激光发射器交错设置；其中，每一个第二行走激光发射器为双向激光发射器；
所述激光发射器组还包括多个位置激光发射器，每一个作业区域设置两个位置激光发射器，并且位于公共清扫机器人每一个作业区域纵向的边缘；
其中，所述第一行走激光发射器组中两端的第一激光发射器分别设有信号检测装置和控制信号发射装置，当所述第一激光发射器被触发时，所述控制信号发射装置按照每一个作业区域的顺序，控制每一个作业区域内，远离第一行走激光发射器组设置的位置激光发射器打开；
在每一个作业区域内远离第一行走激光发射器组设置的位置激光发射器上设有触碰开关，控制与第一行走激光发射器组相近位置上的激光发射器打开；
公共清扫机器人在作业区域内按照激光发射器组发射的激光信号行走作业；
所述公共清扫机器人路径规划系统的控制过程包括：
S1：设置在公共清扫机器人第一作业区域边缘的第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发射激光信号；
S2：行走激光接收器和位置变换接收器接收到激光信号，按照激光信号的引导，公共清扫机器人的控制单元通过控制其行走单元，在第一作业区域内行走作业；
S3：公共清扫机器人按照第一行走激光发射器组中的最后一个激光发射器发射的激光信号，行走出第一作业区域并走向第二作业区域；
S4：设置在第二作业区域边缘的位置激光发射器开启并发射激光信号，公共清扫机器人接收第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发出的激光信号，并根据该激光信号在第二作业区域内行走作业。
2.如权利要求1所述的公共清扫机器人路径规划系统，其特征在于，所述行走激光接收器根据所述第一行走激光发射器组和第二行走激光发射器组，引导公共清扫机器人在工作区域内直线行走；
所述位置变换接收器引导公共清扫机器人转向。
3.如权利要求1所述的公共清扫机器人路径规划系统，其特征在于，每一个第一行走激光发射器与每一个第二行走激光发射器之间的横向距离为公共清扫机器人机体的一个身位宽度。
4.如权利要求1所述的公共清扫机器人路径规划系统，其特征在于，所述激光发射器组中的每一个激光发射器，为线激光束发射器，其发射的激光信号为线激光束信号；每一个第一行走激光发射器和每一个位置激光发射器为单向激光发射器。
5.如权利要求1所述的公共清扫机器人路径规划系统，其特征在于，所述行走激光接收器设置在沿公共清扫机器人行走方向机体中心线上；所述位置变换接收器的数量为两个，并且以该行走激光接收器为中心线对称设置；所述行走激光接收器和位置变换接收器为全向激光接收器。
6.一种如权利要求1-5任一项所述的公共清扫机器人路径规划系统的控制方法，其特征在于，该控制方法包括如下步骤：
S1：设置在公共清扫机器人第一作业区域边缘的第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发射激光信号；
S2：行走激光接收器和位置变换接收器接收到激光信号，按照激光信号的引导，公共清扫机器人的控制单元通过控制其行走单元，在第一作业区域内行走作业；
S3：公共清扫机器人按照第一行走激光发射器组中的最后一个激光发射器发射的激光信号，行走出第一作业区域并走向第二作业区域；
S4：设置在第二作业区域边缘的位置激光发射器开启并发射激光信号，公共清扫机器人接收第一行走激光发射器组、第二行走激光发射器组和位置激光发射器发出的激光信号，并根据该激光信号在第二作业区域内行走作业。
7.如权利要求6所述的控制方法，其特征在于，在S1中，当公共清扫机器人位于第一行走激光发射器组中的第一个行走激光发射器位置时，在该第一个行走激光发射器上设置的信号检测装置被触发，并向控制信号发射装置发出信号，所述控制信号发射装置发出控制信号使远离第一行走激光发射器组设置的位置激光发射器打开；S2具体包括：
S21：公共清扫机器人以第一作业区域的第一边缘为起始位置，按照第一行走激光发射器组所发出的激光信号的引导，沿第一作业区域的第二边缘，在纵向上朝第三边缘直线行走；
S22：公共清扫机器人运动到第一作业区域的第三边缘，所述位置变化接收器接收到远离第一行走激光发射器组设置的位置激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
其中，当公共清扫机器人第一次走到远离第一行走激光发射器组设置的位置激光发射器时，触发设置在该位置激光发射器上的触碰开关，使设置在第一行走激光发射器组相近位置上的激光发射器打开；
S23：公共清扫机器人沿第三边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第二行走激光发射器组发出的激光信号后，停止并原地转向90°；
S24：公共清扫机器人按照第二行走激光发射器组发出的激光信号的引导，在纵向上朝第一边缘直线行走；
S25：公共清扫机器人运动到第一作业区域的第一边缘，所述位置变化接收器接收到设置在第一行走激光发射器组相近位置上的激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
S26：公共清扫机器人沿第一边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第一行走激光发射器组发出的激光信号后，停止并原地转向90°，返回S21；
S27：公共清扫机器人按照激光引导完成第一作业区域内的行走作业。
8.如权利要求6所述的控制方法，其特征在于，在S3中，当公共清扫机器人位于第一行走激光发射器组中的最后一个行走激光发射器位置时，在该行走激光发射器上设置的信号检测装置被触发，并向控制信号发射装置发出信号，所述控制信号发射装置发出控制信号，使第二工作区域内远离第一行走激光发射器组设置的位置激光发射器打开，同时关闭第一工作区域内的位置激光发射器；S4具体包括：
S41：公共清扫机器人以第二作业区域的第一边缘为起始位置，按照第一行走激光发射器组所发出的激光信号的引导，沿第二作业区域的第二边缘，在纵向上朝第三边缘直线行走；
S42：公共清扫机器人运动到第二作业区域的第三边缘，所述位置变化接收器接收到远离第一行走激光发射器组设置的位置激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
其中，当公共清扫机器人第一次走到远离第一行走激光发射器组设置的位置激光发射器时，触发设置在该位置激光发射器上的触碰开关，使设置在第一行走激光发射器组相近位置上的激光发射器打开；
S43：公共清扫机器人沿第三边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第二行走激光发射器组发出的激光信号后，停止并原地转向90°；
S44：公共清扫机器人按照第二行走激光发射器组发出的激光信号的引导，在纵向上朝第一边缘直线行走；
S45：公共清扫机器人运动到第二作业区域的第一边缘，所述位置变化接收器接收到设置在第一行走激光发射器组相近位置上的激光发射器发出的激光信号后，公共清扫机器人停止并原地转向90°；
S46：公共清扫机器人沿第一边缘在横向上对应平移，直到公共清扫机器人上的位置变换接收器接收到第一行走激光发射器组发出的激光信号后，停止并原地转向90°，返回S21；
S47：公共清扫机器人按照激光引导完成第二作业区域内的行走作业。
9.如权利要求7或8所述的控制方法，其特征在于，所述S21和S24以及S41和S44中的直线行走，具体包括：
当所述行走激光接收器接收到激光信号，则控制单元判定公共清扫机器人位于所述直线路径；
否则，控制单元判定公共清扫机器人偏离所述直线路径，控制单元以公共清扫机器人的行走方向为基准进行向左或向右的转向行走调整，直到所述行走激光接收器重新接收到激光信号。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610210202.8A CN107263509B (zh) | 2016-04-06 | 2016-04-06 | 公共清扫机器人路径规划系统及控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610210202.8A CN107263509B (zh) | 2016-04-06 | 2016-04-06 | 公共清扫机器人路径规划系统及控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107263509A CN107263509A (zh) | 2017-10-20 |
| CN107263509B true CN107263509B (zh) | 2024-02-09 |
Family
ID=60052229
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610210202.8A Active CN107263509B (zh) | 2016-04-06 | 2016-04-06 | 公共清扫机器人路径规划系统及控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107263509B (zh) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108762273B (zh) * | 2018-06-05 | 2021-09-10 | 北京智行者科技有限公司 | 一种清扫方法 |
| CN109375628A (zh) * | 2018-11-28 | 2019-02-22 | 南京工程学院 | 一种采用激光定向和射频定位的变电站巡检机器人导航方法 |
| CN113625701A (zh) * | 2020-05-09 | 2021-11-09 | 苏州宝时得电动工具有限公司 | 一种割草机器人路径规划方法及割草机器人 |
Citations (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62135908A (ja) * | 1985-12-09 | 1987-06-18 | Toshihiro Tsumura | 移動体の無人誘導装置 |
| JPH08278818A (ja) * | 1995-04-06 | 1996-10-22 | Matsushita Electric Ind Co Ltd | 自走式ロボットの操舵システム及び自動操舵装置 |
| JP2007153570A (ja) * | 2005-12-07 | 2007-06-21 | Nuclear Fuel Ind Ltd | 障害物検知システム |
| CN101916110A (zh) * | 2010-08-11 | 2010-12-15 | 方正 | 一种清扫机器人和清扫机器人的行走控制方法 |
| CN102121827A (zh) * | 2010-11-29 | 2011-07-13 | 浙江亚特电器有限公司 | 一种移动机器人定位系统及其定位方法 |
| CN203125524U (zh) * | 2013-03-08 | 2013-08-14 | 科沃斯机器人科技(苏州)有限公司 | 自移动机器人激光引导行走作业系统 |
| CN103376801A (zh) * | 2012-04-13 | 2013-10-30 | 科沃斯机器人科技(苏州)有限公司 | 自移动地面处理机器人及其清洁工作的控制方法 |
| CN103955219A (zh) * | 2014-04-26 | 2014-07-30 | 安徽农业大学 | 一种对射式激光拖拉机辅助导航控制系统 |
| CN204654817U (zh) * | 2015-05-28 | 2015-09-23 | 卓永祺 | 一种智能清洁装置 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| FR2671412B1 (fr) * | 1991-01-07 | 1996-10-31 | Guillaume Pepinieres | Dispositif et procede de correction automatique de position d'une machine automotrice du type planteuse agricole. |
| US7091863B2 (en) * | 2004-06-03 | 2006-08-15 | Gary Ravet | System and method for tracking the movement and location of an object in a predefined area |
| WO2006014909A2 (en) * | 2004-07-26 | 2006-02-09 | Somero Enterprises, Inc. | Powered strike-off plow |
| US9182229B2 (en) * | 2010-12-23 | 2015-11-10 | Trimble Navigation Limited | Enhanced position measurement systems and methods |
-
2016
- 2016-04-06 CN CN201610210202.8A patent/CN107263509B/zh active Active
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS62135908A (ja) * | 1985-12-09 | 1987-06-18 | Toshihiro Tsumura | 移動体の無人誘導装置 |
| JPH08278818A (ja) * | 1995-04-06 | 1996-10-22 | Matsushita Electric Ind Co Ltd | 自走式ロボットの操舵システム及び自動操舵装置 |
| JP2007153570A (ja) * | 2005-12-07 | 2007-06-21 | Nuclear Fuel Ind Ltd | 障害物検知システム |
| CN101916110A (zh) * | 2010-08-11 | 2010-12-15 | 方正 | 一种清扫机器人和清扫机器人的行走控制方法 |
| CN102121827A (zh) * | 2010-11-29 | 2011-07-13 | 浙江亚特电器有限公司 | 一种移动机器人定位系统及其定位方法 |
| WO2012071796A1 (zh) * | 2010-11-29 | 2012-06-07 | 嘉兴亚特园林机械研究所 | 一种移动机器人定位系统及其定位方法 |
| CN103376801A (zh) * | 2012-04-13 | 2013-10-30 | 科沃斯机器人科技(苏州)有限公司 | 自移动地面处理机器人及其清洁工作的控制方法 |
| CN203125524U (zh) * | 2013-03-08 | 2013-08-14 | 科沃斯机器人科技(苏州)有限公司 | 自移动机器人激光引导行走作业系统 |
| CN103955219A (zh) * | 2014-04-26 | 2014-07-30 | 安徽农业大学 | 一种对射式激光拖拉机辅助导航控制系统 |
| CN204654817U (zh) * | 2015-05-28 | 2015-09-23 | 卓永祺 | 一种智能清洁装置 |
Non-Patent Citations (5)
| Title |
|---|
| 室内地面清洁机器人路径规划;梁喜凤;;中国计量学院学报(第01期);全文 * |
| 液压挖掘机的操纵和控制系统;肖艳;;工程机械与维修(第11期);全文 * |
| 综采工作面直线度控制系统研究;牛剑峰;;工矿自动化(第05期);全文 * |
| 自行走式地下掘进机器人姿态测量系统的设计;陈双叶;牛经龙;杨汝军;;传感技术学报(第06期);全文 * |
| 高精度线路测量车测量系统及其应用;吴海涛;;铁道建筑(第10期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107263509A (zh) | 2017-10-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107263509B (zh) | 公共清扫机器人路径规划系统及控制方法 | |
| CN107095622B (zh) | 一种用于对接清扫机器人的对接站及清扫机器人 | |
| CN110543168B (zh) | 自移动机器人的行走方法及扫地机器人的行走方法 | |
| CN105759820A (zh) | 基于激光和视觉的道路自主清扫控制系统及控制方法 | |
| CN205507542U (zh) | 基于激光和视觉的道路自主清扫控制系统 | |
| EP2312411B1 (en) | Docking station for a cleaning robot with duration coded guiding signals | |
| US20180120852A1 (en) | Mobile robot and navigating method for mobile robot | |
| CN106843239B (zh) | 基于地图预测的机器人运动控制方法 | |
| KR101021267B1 (ko) | 청소로봇 시스템 및 그 제어 방법 | |
| JP3296105B2 (ja) | 自律移動ロボット | |
| TW200743477A (en) | Omni-directional robot cleaner | |
| WO2016031702A1 (ja) | 自律走行体装置 | |
| CN105739500A (zh) | 一种智能扫地机器人的交互控制方法及装置 | |
| CN105563485B (zh) | 一种送餐机器人控制系统运动轨迹控制方法 | |
| CN203125524U (zh) | 自移动机器人激光引导行走作业系统 | |
| CN102597898A (zh) | 场地中的车辆移动协调 | |
| JP2014075133A (ja) | 自律カバレッジロボットナビゲーションシステム | |
| CN104029207A (zh) | 自移动机器人激光引导行走作业系统及其控制方法 | |
| CN105125144B (zh) | 基于物联网的清洁机 | |
| CN102591338A (zh) | 擦玻璃机器人的控制系统及其控制方法 | |
| CN205704223U (zh) | 公共清扫机器人路径规划系统 | |
| CN105022395A (zh) | 前向跟随装置及其跟随控制方法 | |
| WO2009075051A1 (ja) | 目標経路設定支援システム | |
| CN105619410A (zh) | 一种搬运机器人及自动搬运系统 | |
| CN105856245A (zh) | 基于tdoa定位的室内服务机器人系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |