CN114603556A - Robot control method, control system, electronic device and readable storage device - Google Patents
Robot control method, control system, electronic device and readable storage device Download PDFInfo
- Publication number
- CN114603556A CN114603556A CN202210216565.8A CN202210216565A CN114603556A CN 114603556 A CN114603556 A CN 114603556A CN 202210216565 A CN202210216565 A CN 202210216565A CN 114603556 A CN114603556 A CN 114603556A
- Authority
- CN
- China
- Prior art keywords
- robot
- cleaning
- navigation module
- warehouse
- task
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 89
- 238000004140 cleaning Methods 0.000 claims abstract description 243
- 230000004044 response Effects 0.000 claims description 16
- 238000004891 communication Methods 0.000 claims description 2
- 230000008569 process Effects 0.000 description 18
- 238000012545 processing Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 6
- 239000002184 metal Substances 0.000 description 6
- 108010076504 Protein Sorting Signals Proteins 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 3
- 230000008447 perception Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 2
- 238000010248 power generation Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000010348 incorporation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
- B25J9/1666—Avoiding collision or forbidden zones
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域technical field
本申请涉及机器控制领域,特别是涉及一种清扫机器人控制方法、清扫机器人控制系统、电子设备及计算机存储装置。The present application relates to the field of machine control, and in particular, to a cleaning robot control method, a cleaning robot control system, electronic equipment and a computer storage device.
背景技术Background technique
随着新能源技术的迅猛发展,太阳能光伏发电已经广泛运用,并产生了各式各样的匹配当地环境条件的光伏电站,比如大型地面光伏电站,屋顶分布式光伏电站等等。而由于光伏电站面板需要接收太阳光,因此需要保持光伏面板的干净整洁,避免异物的遮挡阻碍,影响光伏面板的发电效率。对于光伏面板的清扫目前主要采用人工清扫运维,但是这种清扫方式效率低且工作难度大。还有一种运维方式是使用清扫机器人进行清扫运维。而清扫机器人的电池容量是有限的,当电池容量消耗殆尽时需要进行充电续航,而如何对清扫机器人进行自动控制使其精准完成出入库操作,从而进行续航完成多个清扫任务或长时间的清扫任务是本领域技术人员亟需解决的技术问题。With the rapid development of new energy technology, solar photovoltaic power generation has been widely used, and various photovoltaic power plants matching local environmental conditions have been produced, such as large-scale ground photovoltaic power plants, rooftop distributed photovoltaic power plants and so on. Since the photovoltaic power station panel needs to receive sunlight, it is necessary to keep the photovoltaic panel clean and tidy to avoid the obstruction of foreign objects, which will affect the power generation efficiency of the photovoltaic panel. For the cleaning of photovoltaic panels, manual cleaning and operation and maintenance are currently mainly used, but this cleaning method is inefficient and difficult to work. Another way of operation and maintenance is to use a cleaning robot for cleaning operation and maintenance. The battery capacity of the cleaning robot is limited. When the battery capacity is exhausted, it needs to be charged for battery life. How to automatically control the cleaning robot so that it can accurately complete the in and out operations, so as to continue to complete multiple cleaning tasks or a long time. The cleaning task is a technical problem that those skilled in the art need to solve urgently.
发明内容SUMMARY OF THE INVENTION
本申请主要目的是提供一种清扫机器人控制方法、清扫机器人控制系统、电子设备及计算机存储装置,能够解决如何对清扫机器人进行自动控制的技术问题。The main purpose of this application is to provide a cleaning robot control method, a cleaning robot control system, electronic equipment and a computer storage device, which can solve the technical problem of how to automatically control the cleaning robot.
为解决上述技术问题,本申请采用的第一个技术方案是:提供一种清扫机器人控制方法。该方法包括获取清扫指令;响应于清扫指令,开启第一导航模块,并利用第一导航模块引导机器人出库,以控制机器人根据清扫指令完成清扫任务;响应于清扫任务完成,开启第二导航模块,并利用第一导航模块和第二导航模块引导机器人入库;其中,第二导航模块为磁条导航模块。In order to solve the above technical problems, the first technical solution adopted in the present application is to provide a control method for a cleaning robot. The method includes acquiring a cleaning instruction; in response to the cleaning instruction, turning on a first navigation module, and using the first navigation module to guide a robot out of the warehouse, so as to control the robot to complete the cleaning task according to the cleaning command; in response to the completion of the cleaning task, turning on the second navigation module , and use the first navigation module and the second navigation module to guide the robot into storage; wherein, the second navigation module is a magnetic stripe navigation module.
为解决上述技术问题,本申请采用的第二个技术方案是:提供一种电子设备。该电子设备包括存储器和处理器,存储器用于存储程序数据,程序数据能够被处理器执行,以实现如第一个技术方案中所述的方法。In order to solve the above technical problem, the second technical solution adopted in this application is to provide an electronic device. The electronic device includes a memory and a processor, the memory is used for storing program data, and the program data can be executed by the processor to implement the method as described in the first technical solution.
为解决上述技术问题,本申请采用的第三个技术方案是:提供一种计算机可读存储装置。该计算机可读存储装置存储有程序数据,能够被处理器执行,以实现如第一个技术方案中所述的方法。In order to solve the above technical problem, the third technical solution adopted in the present application is to provide a computer-readable storage device. The computer-readable storage device stores program data and can be executed by a processor to implement the method described in the first technical solution.
为解决上述技术问题,本申请采用的第四个技术方案是:提供一种清扫机器人控制系统。该系统包括至少一机器人;如第二个技术方案中所述的电子设备,与机器人通信连接,能够实现如第一个技术方案中所述的方法;机器人库,设置有入库线,出库线以及出入库定位装置;其中入库线长于出库线,入库线、出库线以及出入库定位装置用于引导机器人完成出入库。In order to solve the above technical problems, the fourth technical solution adopted in this application is to provide a cleaning robot control system. The system includes at least one robot; the electronic device as described in the second technical solution is connected in communication with the robot, and can implement the method described in the first technical solution; the robot warehouse is provided with a warehouse entry line, and the warehouse exits Line and inbound and outbound positioning device; the inbound line is longer than the outbound line, and the inbound line, the outbound line and the inbound and outbound positioning device are used to guide the robot to complete the inbound and outbound.
本申请的有益效果是:区别于现有技术的情况,本申请通过使用两种导航模块引导清扫机器人。第一导航模式引导清扫机器人出库以及帮助清扫机器人定位,使其在对应的清扫区域中完成清扫任务,而第二导航模式与第一导航模式相配合引导清扫机器人入库。第二导航模式为磁条导航模式,是一种基于场地中预先设置的磁条进行导航的控制模式,由于是根据实地设置的物体进行导航,因此磁条导航能够精准地将清扫机器人引导至入库时的指定位置。两导航模式的相互配合使得清扫机器人能够自行完成出入库操作,并在入库时达到指定位置,从而能够开启充电等续航操作,进而继续进行下一次的清扫任务的执行,使得清扫机器人能够自行完成多个清扫任务或长时间的清扫任务而无需人工操作。The beneficial effects of the present application are: different from the situation in the prior art, the present application guides the cleaning robot by using two kinds of navigation modules. The first navigation mode guides the cleaning robot out of the warehouse and helps the cleaning robot to locate it so that it can complete the cleaning task in the corresponding cleaning area, while the second navigation mode cooperates with the first navigation mode to guide the cleaning robot into the warehouse. The second navigation mode is the magnetic strip navigation mode, which is a control mode for navigation based on the magnetic strips preset in the field. Since the navigation is based on the objects set in the field, the magnetic strip navigation can accurately guide the cleaning robot to the entrance. The specified location when the library is used. The cooperation of the two navigation modes enables the cleaning robot to complete the operation of entering and leaving the warehouse by itself, and reaches the designated position when entering the warehouse, so that it can start the battery life operation such as charging, and then continue to perform the next cleaning task, so that the cleaning robot can complete it by itself Multiple cleaning tasks or long cleaning tasks without manual operation.
附图说明Description of drawings
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to illustrate the technical solutions in the embodiments of the present invention more clearly, the following briefly introduces the accompanying drawings used in the description of the embodiments. Obviously, the accompanying drawings in the following description are only some embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained from these drawings without creative effort.
图1是本申请清扫机器人控制方法第一实施例的流程示意图;1 is a schematic flowchart of the first embodiment of the cleaning robot control method of the present application;
图2是本申请机器人库一结构示意图;Fig. 2 is a schematic diagram of the structure of the robot library of the present application;
图3是本申请清扫机器人控制方法第二实施例的流程示意图;3 is a schematic flowchart of a second embodiment of the cleaning robot control method of the present application;
图4是本申请清扫机器人控制方法第三实施例的流程示意图;4 is a schematic flowchart of a third embodiment of the cleaning robot control method of the present application;
图5是本申请清扫机器人控制方法第四实施例的流程示意图;5 is a schematic flowchart of a fourth embodiment of the cleaning robot control method of the present application;
图6是本申请清扫机器人控制方法第五实施例的流程示意图;6 is a schematic flowchart of a fifth embodiment of the cleaning robot control method of the present application;
图7是本申请清扫机器人控制方法第六实施例的流程示意图;FIG. 7 is a schematic flowchart of the sixth embodiment of the cleaning robot control method of the present application;
图8是本申请清扫机器人控制方法第七实施例的流程示意图;8 is a schematic flowchart of a seventh embodiment of the cleaning robot control method of the present application;
图9是本申请清扫机器人控制方法第八实施例的流程示意图;9 is a schematic flowchart of an eighth embodiment of the cleaning robot control method of the present application;
图10是本申请清扫机器人控制方法第九实施例的流程示意图;10 is a schematic flowchart of a ninth embodiment of a cleaning robot control method of the present application;
图11是本申请清扫机器人控制方法第十实施例的流程示意图;11 is a schematic flowchart of a tenth embodiment of a cleaning robot control method of the present application;
图12是本申请清扫机器人控制方法第十一实施例的流程示意图;FIG. 12 is a schematic flowchart of the eleventh embodiment of the cleaning robot control method of the present application;
图13是本申请清扫机器人控制方法第十二实施例的流程示意图;13 is a schematic flowchart of the twelfth embodiment of the cleaning robot control method of the present application;
图14是本申请清扫机器人控制方法第十三实施例的流程示意图;14 is a schematic flowchart of the thirteenth embodiment of the cleaning robot control method of the present application;
图15是本申请清扫机器人控制方法第十四实施例的流程示意图;FIG. 15 is a schematic flowchart of the fourteenth embodiment of the cleaning robot control method of the present application;
图16是本申请电子设备一实施例的结构示意图;16 is a schematic structural diagram of an embodiment of an electronic device of the present application;
图17是本申请计算机可读存储装置一实施例的结构示意图;17 is a schematic structural diagram of an embodiment of a computer-readable storage device of the present application;
图18是本申请机器人控制系统一实施例的结构示意图。FIG. 18 is a schematic structural diagram of an embodiment of a robot control system of the present application.
具体实施方式Detailed ways
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本申请的一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。The technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the drawings in the embodiments of the present application. Obviously, the described embodiments are only a part of the embodiments of the present application, but not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present application.
本申请中的术语“第一”、“第二”等是用于区别不同对象,而不是用于描述特定顺序。此外,术语“包括”和“具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其它步骤或单元。The terms "first", "second", etc. in this application are used to distinguish different objects, rather than to describe a specific order. Furthermore, the terms "comprising" and "having" and any variations thereof are intended to cover non-exclusive inclusion. For example, a process, method, system, product or device comprising a series of steps or units is not limited to the listed steps or units, but optionally also includes unlisted steps or units, or optionally also includes For other steps or units inherent to these processes, methods, products or devices.
在本文中提及“实施例”意味着,结合实施例描述的特定特征、结构或特性可以包含在本申请的至少一个实施例中。在说明书中的各个位置出现该短语并不一定均是指相同的实施例,也不是与其它实施例互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解的是,本文所描述的实施例可以与其它实施例相结合。Reference herein to an "embodiment" means that a particular feature, structure, or characteristic described in connection with the embodiment can be included in at least one embodiment of the present application. The appearances of the phrase in various places in the specification are not necessarily all referring to the same embodiment, nor a separate or alternative embodiment that is mutually exclusive of other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.
如图1所示,图1为本申请清扫机器人控制方法第一实施例的流程示意图。其包括以下步骤:As shown in FIG. 1 , FIG. 1 is a schematic flowchart of a first embodiment of a cleaning robot control method of the present application. It includes the following steps:
S11:获取清扫指令。S11: Obtain a cleaning instruction.
获取下发的清扫指令,基于清扫指令,机器人开始进行清扫任务。清扫指令的下发可以是根据预先设置的清扫机器人的工作运行时段,从绑定的气象站获取的气象信息而决定的。当处于清扫机器人工作时段并且气象状况良好的情况下,能够向清扫机器人发送清扫指令。Get the cleaning instruction issued, and based on the cleaning instruction, the robot starts to perform the cleaning task. The issuing of the cleaning instruction may be determined according to the preset working operation period of the cleaning robot and the weather information obtained from the bound weather station. When the cleaning robot is in the working period and the weather conditions are good, a cleaning instruction can be sent to the cleaning robot.
若此时清扫机器人还处于充电状态,会向用户终端或上级控制端进行提示,提醒是否停止充电状态,开始执行清扫指令。If the cleaning robot is still in the charging state at this time, it will prompt the user terminal or the upper-level control terminal to remind whether to stop the charging state and start to execute the cleaning command.
S12:响应于清扫指令,开启第一导航模块,并利用第一导航模块引导机器人出库,以控制所述机器人根据所述清扫指令完成清扫任务。S12: In response to the cleaning instruction, turn on the first navigation module, and use the first navigation module to guide the robot out of the warehouse, so as to control the robot to complete the cleaning task according to the cleaning instruction.
开始执行清扫任务时,先行开启第一导航模式以引导清扫机器人驶出机器人库。机器人库设置有停车位,充电装置等,用于清扫机器人的停放以及续航充电。第一导航模块为RTK导航模块。RTK(Real-time kinematic,实时动态)载波相位差分技术,是实时处理两个测量站载波相位观测量的差分方法,将基准站采集的载波相位发给用户接收机,进行求差解算坐标。这是一种卫星定位测量方法,能够实时的得到厘米级精度的测量结果,极大的提高了工作的效率以及精度。出库以及人物执行过程中,通过RTK导航能够使清扫机器人的工作更加精确,减少了因定位精度不够导致的重复清扫,超出清扫区域等问题。When starting the cleaning task, firstly enable the first navigation mode to guide the cleaning robot to drive out of the robot library. The robot library is provided with parking spaces, charging devices, etc., which are used for parking and battery charging of cleaning robots. The first navigation module is an RTK navigation module. RTK (Real-time kinematic, real-time dynamic) carrier phase differential technology is a differential method for real-time processing of the carrier phase observations of two measuring stations. The carrier phase collected by the base station is sent to the user receiver for differential calculation of coordinates. This is a satellite positioning measurement method, which can obtain measurement results with centimeter-level accuracy in real time, which greatly improves the efficiency and accuracy of work. During the process of outbound and character execution, RTK navigation can make the work of the cleaning robot more accurate, reducing repeated cleaning caused by insufficient positioning accuracy and exceeding the cleaning area.
S13:响应于清扫任务完成,开启第二导航模块,并利用第一导航模块和第二导航模块引导机器人入库。S13: In response to the completion of the cleaning task, the second navigation module is turned on, and the first navigation module and the second navigation module are used to guide the robot into storage.
清扫机器人完成清扫任务或基于突发情况需要中断当前清扫任务强制完成进行入库时,将开启第二导航模块。第二导航模块为磁条导航模块。第二导航模块基于场地中预先设置的磁条对清扫机器人进行定位引导,以帮助清扫机器人达到指定的位置地点,进而完成后续的清扫机器人的停放和续航操作。When the cleaning robot completes the cleaning task or needs to interrupt the current cleaning task forcibly to complete the warehousing based on emergencies, the second navigation module will be turned on. The second navigation module is a magnetic stripe navigation module. The second navigation module positions and guides the cleaning robot based on the magnetic strips preset in the field, so as to help the cleaning robot reach the designated location, and then complete the subsequent parking and endurance operations of the cleaning robot.
在一实施例中,机器人库如图2所示。In one embodiment, the robot library is shown in FIG. 2 .
机器人库设置有出库线和入库线,出库线和入库线的确定可以通过RTK导航确定以实现对于清扫机器人的出入库控制。而入库线一般较长,出库线一般较短,入库线长于出库线。这是为了使得清扫机器人在完成出库之后能够及时的开始进行清扫,较长的入库线能够让机器人在入库的过程中能够有足够的空间进行身位的调整,进行转弯倒车等操作,从而以预定身位进行停放开始充电。出库线位于工作区域的长度一般设置0.5-2倍的机器人本体长度,而入库线位于工作区域的长度一般设置2-3倍的机器人本体长度。磁条导航所使用的磁条设置在入库线上,与入库线重合,可选为与入库线10%-100%重叠。当入库时磁条传感器检测到磁条时,开启磁条导航模块。此时清扫机器人仅依靠磁条导航模块进行入库操作,直至进入停车位进行充电。The robot library is provided with an outbound line and an inbound line, and the determination of the outbound line and the inbound line can be determined by RTK navigation to realize the inbound and outbound control of the cleaning robot. The inbound line is generally longer, the outbound line is generally shorter, and the inbound line is longer than the outbound line. This is to enable the cleaning robot to start cleaning in a timely manner after it finishes leaving the warehouse. The longer entry line allows the robot to have enough space to adjust its position and perform operations such as turning and reversing during the process of entering the warehouse. Thereby, it is parked in a predetermined position to start charging. The length of the outbound line in the working area is generally set to 0.5-2 times the length of the robot body, while the length of the inbound line in the work area is generally set to 2-3 times the length of the robot body. The magnetic strip used for magnetic strip navigation is set on the storage line, which overlaps with the storage line, and can be selected to overlap with the storage line by 10%-100%. When the magnetic strip sensor detects the magnetic strip during storage, the magnetic strip navigation module is turned on. At this time, the cleaning robot only relies on the magnetic strip navigation module for storage operations until it enters the parking space for charging.
如图3所示,图3为本申请清扫机器人控制方法第二实施例的流程示意图。该实施例是对步骤S12的进一步扩展。其包括以下步骤:As shown in FIG. 3 , FIG. 3 is a schematic flowchart of the second embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of step S12. It includes the following steps:
S21:检测是否存在出入库定位装置。S21: Detect whether there is an in-out storage positioning device.
在引导清扫机器人出库执行清扫任务时,需先检测出入库装置是否存在。出入库装置为机器人库停车位尾部设置的金属片。清扫机器人尾部设置有一霍尔传感器,能够检测该金属片。当霍尔传感器检测到该金属片即表明清扫机器人停放在正确的位置上且充电完毕,能够出库完成清扫任务。执行步骤S22。When guiding the cleaning robot out of the warehouse to perform the cleaning task, it is necessary to detect whether the in-out device exists. The access device is a metal piece set at the rear of the parking space of the robot garage. The rear of the cleaning robot is provided with a Hall sensor, which can detect the metal piece. When the Hall sensor detects the metal sheet, it means that the cleaning robot is parked in the correct position and the charging is completed, and it can leave the warehouse to complete the cleaning task. Step S22 is performed.
S22:开启第一导航模块以引导机器人出库。S22: Turn on the first navigation module to guide the robot out of the warehouse.
若否,表明清扫机器人的停放位置不正确,可能并没有完成充电操作,执行步骤S23。If not, it indicates that the parking position of the cleaning robot is incorrect, and the charging operation may not be completed, and step S23 is executed.
S23:执行报警提示。S23: Execute an alarm prompt.
向用户终端或上级控制端进行报警提示,提醒用户对清扫机器人进行检查。Send an alarm to the user terminal or the upper-level control terminal to remind the user to check the cleaning robot.
本实施例中所使用的霍尔传感器以及金属片可以替换为其他能够执行相应检测步骤的装置,在此不做限定。The Hall sensor and the metal sheet used in this embodiment can be replaced with other devices capable of performing corresponding detection steps, which are not limited herein.
如图4所示,图4为本申请清扫机器人控制方法第三实施例的流程示意图。该实施例是对步骤S13的进一步扩展。其包括以下步骤:As shown in FIG. 4 , FIG. 4 is a schematic flowchart of the third embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of step S13. It includes the following steps:
S31:检测是否存在磁条。S31: Detect whether there is a magnetic stripe.
在进行入库的过程中,首先是利用RTK导航模式将清扫机器人引导至入库线位于工作区域的端点,然后向机器人库前进,而后使用磁条导航实现精准入库。在入库的过程中需要对RTK导航模式和磁条导航模式进行切换,要使用磁条导航就需要使得清扫机器人能够检测到磁条。若磁条传感器能够检测到磁条,执行步骤S32。In the process of warehousing, first use the RTK navigation mode to guide the cleaning robot to the end point of the warehousing line in the working area, then move forward to the robot warehouse, and then use the magnetic stripe navigation to achieve accurate warehousing. In the process of storage, it is necessary to switch the RTK navigation mode and the magnetic strip navigation mode. To use the magnetic strip navigation, it is necessary to enable the cleaning robot to detect the magnetic strip. If the magnetic stripe sensor can detect the magnetic stripe, step S32 is executed.
S32:仅利用第二导航模块引导机器人入库。S32: Only use the second navigation module to guide the robot into the warehouse.
关闭RTK导航模式,仅使用磁条导航以利用预先设置的磁条对清扫机器人进行精准入库。Turn off the RTK navigation mode, and only use the magnetic strip to navigate to use the pre-set magnetic strip to accurately store the cleaning robot.
如图5所示,图5为本申请清扫机器人控制方法第四实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 5 , FIG. 5 is a schematic flowchart of the fourth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S41:预设一计时器,设置有第一时间阈值和第二时间阈值。S41: Preset a timer with a first time threshold and a second time threshold.
在入库的过程中,虽然RTK导航已经达到了厘米级的定位精度,但是依旧可能在行进路径上存在误差使得磁条传感器无法检测到磁条,因此为磁条检测设定一第一时间阈值以对未检测到磁条的情况进行处理。而即使磁条导航正确,可能出现出入库定位装置检测失效等情况,使得清扫机器人无法识别出入库定位装置一直前进而不能停到指定位置,因此根据入库线长度等因素设定一第二时间阈值以确保清扫机器人能够停放正确。计时器能够从清扫机器人达到入库线位于工作区域的端点时开始进行计时。In the process of warehousing, although RTK navigation has reached centimeter-level positioning accuracy, there may still be errors in the travel path that make the magnetic stripe sensor unable to detect the magnetic stripe. Therefore, a first time threshold is set for the magnetic stripe detection. to handle the case where the magnetic stripe is not detected. Even if the magnetic stripe navigation is correct, the detection of the inbound and outbound positioning device may fail, so that the cleaning robot cannot recognize that the inbound and outbound positioning device has been moving forward and cannot stop at the designated position. Therefore, a second time is set according to factors such as the length of the inbound and outbound lines. Threshold to ensure that the cleaning robot can park correctly. The timer can start when the cleaning robot reaches the end of the inbound line at the work area.
S42:判断在第一时间阈值内是否检测到磁条。S42: Determine whether the magnetic stripe is detected within the first time threshold.
若在所述第一时间阈值内未检测到磁条,则执行报警提示。If the magnetic stripe is not detected within the first time threshold, an alarm prompt is executed.
S43:判断在第二时间阈值内是否检测到出入库定位装置。S43: Determine whether the warehouse-in/outbound positioning device is detected within the second time threshold.
若在所述第二时间阈值内未检测到所述出入库定位装置,则进行报警提示。If the inbound and outbound positioning device is not detected within the second time threshold, an alarm will be prompted.
S44:执行报警提示。S44: Execute an alarm prompt.
在一实施例中,还能设定一计时器,设置有第三时间阈值,比如设定5秒。当清扫机器人在入库过程中导航模块未检测到入库线,或磁条导航模块的检测磁条存在部分残缺导致磁条检测模块失效时,开始第三时间阈值的倒计时,若在时间范围内重新检测到入库线或磁条等,就重置第三时间阈值的计时器。In one embodiment, a timer can also be set with a third time threshold, for example, 5 seconds. When the navigation module of the cleaning robot does not detect the storage line during the storage process, or the magnetic strip detection module of the magnetic strip navigation module is partially defective and the magnetic strip detection module fails, the countdown to the third time threshold starts. If it is within the time range When the incoming line or magnetic strip is detected again, the timer for the third time threshold is reset.
如图6所示,图6为本申请清扫机器人控制方法第五实施例的流程示意图。该实施例是对步骤S12的进一步扩展。其包括以下步骤:As shown in FIG. 6 , FIG. 6 is a schematic flowchart of the fifth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of step S12. It includes the following steps:
S51:检测是否存在任务中断点。S51: Detect whether there is a task interruption point.
在清扫机器人出库完成后,即将执行清扫任务时,首先检测是否存在任务中断点。任务中断点为由于突发情况或清扫机器人电量不足等原因使得清扫机器人必须停止清扫任务进行入库时的地点。若检测到任务中断点,执行步骤S52。After the cleaning robot is out of the warehouse, when the cleaning task is about to be performed, it is first detected whether there is a task interruption point. The task interruption point is the place where the cleaning robot must stop the cleaning task for storage due to emergencies or insufficient power of the cleaning robot. If the task interruption point is detected, step S52 is executed.
S52:从任务中断点开始清扫任务。S52: Start the cleaning task from the task interruption point.
从任务中断点开始,完成上一次未完成的清扫任务。完成之后再执行本次的清扫任务或完成所有清扫任务入库停止工作。Complete the last unfinished cleaning task from the point where the task was interrupted. After completion, perform this cleaning task or complete all cleaning tasks and put them into storage to stop working.
如图7所示,图7为本申请清扫机器人控制方法第六实施例的流程示意图。该实施例是对步骤S52的进一步扩展。其包括以下步骤:As shown in FIG. 7 , FIG. 7 is a schematic flowchart of the sixth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of step S52. It includes the following steps:
S61:计算当前位置到达任务中断点的最短距离。S61: Calculate the shortest distance from the current position to the task interruption point.
检测到任务中断点后,可根据事先存储的地图信息对周围的环境进行分析,得到能够到达该任务中断点的最短距离。After the mission interruption point is detected, the surrounding environment can be analyzed according to the map information stored in advance, and the shortest distance that can reach the mission interruption point can be obtained.
S62:根据最短距离控制机器人达到任务中断点。S62: Control the robot to reach the task interruption point according to the shortest distance.
根据计算得到的最短距离达到任务中断点,能够尽早的执行未完成的清扫任务,节约清扫机器人的电力资源。According to the shortest distance calculated, the task interruption point can be reached, and the unfinished cleaning task can be executed as soon as possible, saving the power resources of the cleaning robot.
如图8所示,图8为本申请清扫机器人控制方法第七实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 8 , FIG. 8 is a schematic flowchart of a seventh embodiment of a cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S71:检测机器人电量是否低于第一阈值。S71: Detect whether the power of the robot is lower than the first threshold.
在清扫机器人的工作过程中,需对机器人的电量进行检测,以确保清扫机器人有足够的电量完成入库操作而不至于在中途断电停止工作。该第一阈值可以设置为20%。During the working process of the cleaning robot, the power of the robot needs to be detected to ensure that the cleaning robot has enough power to complete the storage operation and will not stop working in the middle of power failure. The first threshold may be set to 20%.
S72:标记当前位置为任务中断点并控制机器人入库。S72: Mark the current position as the task interruption point and control the robot to put it into storage.
当检测到清扫机器人的剩余电量达到了第一阈值时,记录当前的位置信息,将该位置标记为任务中断点,用于提示清扫机器人充电完成后从此处继续执行清扫任务。标记完成后通过RTK导航引导清扫机器人进行入库。When it is detected that the remaining power of the cleaning robot reaches the first threshold, the current position information is recorded, and the position is marked as the task interruption point, which is used to prompt the cleaning robot to continue to perform the cleaning task from here after charging is completed. After the marking is completed, the cleaning robot is guided through RTK navigation for storage.
如图9所示,图9为本申请清扫机器人控制方法第八实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 9 , FIG. 9 is a schematic flowchart of an eighth embodiment of a cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S81:检测当前天气状况是否满足安全运行条件。S81: Detect whether the current weather condition satisfies the safe operation condition.
在清扫机器人的工作过程中,需检测当前的天气状况是否支持清扫机器人继续进行清扫工作。During the working process of the cleaning robot, it is necessary to detect whether the current weather conditions support the cleaning robot to continue the cleaning work.
S82:标记当前位置为任务中断点并控制机器人入库。S82: Mark the current position as the task interruption point and control the robot to put it into storage.
若从相关的气象站获取到当前的天气状况无法满足安全运行条件时,记录当前的位置信息,将该位置标记为任务中断点,用于提示清扫机器人充电完成后从此处继续执行清扫任务。标记完成后通过RTK导航引导清扫机器人进行入库。If it is obtained from the relevant weather station that the current weather conditions cannot meet the safe operation conditions, the current location information is recorded, and the location is marked as the task interruption point, which is used to prompt the cleaning robot to continue the cleaning task from here after charging is completed. After the marking is completed, the cleaning robot is guided through RTK navigation for storage.
如图10所示,图10为本申请清扫机器人控制方法第九实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 10 , FIG. 10 is a schematic flowchart of the ninth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S91:检测当前时间是否处于预设工作时间段。S91: Detect whether the current time is within a preset working time period.
清扫机器人的工作可以预设一工作时间段,当处于工作时间段时,清扫机器人出库完成清扫任务,当处于非工作时间段时,清扫机器人入库进行停放或充电。The work of the cleaning robot can be preset for a working time period. When it is in the working time period, the cleaning robot goes out of the warehouse to complete the cleaning task, and when it is in the non-working time period, the cleaning robot enters the warehouse for parking or charging.
S92:标记当前位置为任务中断点并控制机器人入库。S92: Mark the current position as the task interruption point and control the robot to put it into storage.
若清扫机器人在执行清扫任务中途到了非工作时间段,记录当前的位置信息,将该位置标记为任务中断点,用于提示清扫机器人充电完成后从此处继续执行清扫任务。标记完成后通过RTK导航引导清扫机器人进行入库。If the cleaning robot is in the non-working time period in the middle of the cleaning task, the current position information is recorded, and the position is marked as the task interruption point, which is used to prompt the cleaning robot to continue the cleaning task from here after charging is completed. After the marking is completed, the cleaning robot is guided through RTK navigation for storage.
在上述实施例中,当标记了任务中断点之后,清扫机器人根据预先存储的地图信息计算出当前位置返回至入库线的最短返航路线,根据该返航路线到达入库线进行入库。In the above embodiment, after the task interruption point is marked, the cleaning robot calculates the shortest return route from the current position to the storage line according to the pre-stored map information, and reaches the storage line according to the return route for storage.
如图11所示,图11为本申请清扫机器人控制方法第十实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 11 , FIG. 11 is a schematic flowchart of the tenth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S101:检测机器人本体的运动状态与机器人的底盘的运动状态是否存在偏差。S101: Detect whether there is a deviation between the motion state of the robot body and the motion state of the chassis of the robot.
在清扫机器人进行清扫的过程中,对机器人本体的运动状态与机器人的底盘控制计算的运动状态进行比较,以判断清扫机器人是否存在打滑等问题。例如,定位模块采集到机器人本体运动了5米,而底盘控制装置根据滑轮计算到机器人移动的距离为10米,再结合事先设定的一偏差阈值,如1米,定位模块的计算结果与底盘控制的计算结果差值大于该偏差阈值,表明清扫机器人在该路段存在打滑现象,使得实际运动距离偏小。在转弯过程中,定位模块采集机器人本体的航向角信息,机器人本体偏移了20度,而底盘控制装置计算得到的偏转角度为100度,结合事先设定的一偏差阈值,如30度,定位模块的计算结果与底盘控制的计算结果差值大于该偏差阈值,表明清扫机器人在转弯的过程中存在打滑现象。During the cleaning process of the cleaning robot, the motion state of the robot body is compared with the motion state calculated by the chassis control of the robot to determine whether the cleaning robot has problems such as slippage. For example, the positioning module collects that the robot body has moved 5 meters, and the chassis control device calculates the distance from the robot to the movement of 10 meters according to the pulley. Combined with a pre-set deviation threshold, such as 1 meter, the calculation result of the positioning module is the same as that of the chassis. The difference between the calculated results of the control is greater than the deviation threshold, indicating that the cleaning robot has a slipping phenomenon in this road section, which makes the actual moving distance small. During the turning process, the positioning module collects the heading angle information of the robot body. The robot body is offset by 20 degrees, while the deflection angle calculated by the chassis control device is 100 degrees. Combined with a preset deviation threshold, such as 30 degrees, positioning The difference between the calculation result of the module and the calculation result of the chassis control is greater than the deviation threshold, indicating that the cleaning robot has a slipping phenomenon in the process of turning.
S102:执行报警提示。S102: Execute an alarm prompt.
当检测到清扫机器人本体的运动状态的检测结果与底盘控制装置的计算结果偏差超过了设定偏差阈值时,视为存在偏差。清扫机器人在该路段可能存在打滑现象。向用户进行报警提示以对该路段或清扫机器人进行检查。When it is detected that the difference between the detection result of the motion state of the cleaning robot body and the calculation result of the chassis control device exceeds the set deviation threshold, it is deemed that there is a deviation. The cleaning robot may slip on this road section. Alert the user to check the road section or the cleaning robot.
如图12所示,图12为本申请清扫机器人控制方法第十一实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 12 , FIG. 12 is a schematic flowchart of the eleventh embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S111:检测工作电流的数值是否大于第二阈值且持续时间大于第三阈值。S111: Detect whether the value of the working current is greater than the second threshold and the duration is greater than the third threshold.
在清扫机器人工作过程中,需不断地对工作电流进行检测。若清扫机器人的工作电流处于较大数值且持续了较长时间,有可能会对清扫机器人的相关模块或电路结构造成影响,使得清扫机器人损坏。例如,清扫机器人的工作电流在大于15000毫安的范围内持续了100毫秒,则表明此时清扫机器人的工作电流处于一个较危险的状态。During the working process of the cleaning robot, it is necessary to continuously detect the working current. If the working current of the cleaning robot is at a large value and lasts for a long time, it may affect the related modules or circuit structure of the cleaning robot, causing damage to the cleaning robot. For example, if the working current of the cleaning robot is in the range of more than 15000 mA for 100 milliseconds, it indicates that the working current of the cleaning robot is in a dangerous state at this time.
S112:控制机器人停止工作并报警提示。S112: Control the robot to stop working and give an alarm.
当检测到清扫机器人的工作电流不正常时,及时停止清扫机器人的相关工作,并对清扫机器人作断电处理,以及向用户端进行报警提示对机器人进行检查和修复。When it is detected that the working current of the cleaning robot is abnormal, the related work of the cleaning robot will be stopped in time, the power off of the cleaning robot will be processed, and an alarm will be sent to the user terminal to check and repair the robot.
如图13所示,图13为本申请清扫机器人控制方法第十二实施例的流程示意图。该实施例是对上述实施例的进一步扩展。其包括以下步骤:As shown in FIG. 13 , FIG. 13 is a schematic flowchart of a twelfth embodiment of a cleaning robot control method of the present application. This embodiment is a further extension of the above-mentioned embodiment. It includes the following steps:
S121:检测清扫区域上是否存在障碍。S121: Detect whether there is an obstacle on the cleaning area.
清扫过程中,清扫机器人能够通过感知模块检测行进方向上是否存在坑洼,悬崖等障碍物。该感知模块可以是电容传感器。在清扫机器人的左前方、右前方、左后方、右后方分别设置四个电容传感器以对其周围的环境进行检测。During the cleaning process, the cleaning robot can detect whether there are obstacles such as potholes and cliffs in the traveling direction through the perception module. The sensing module may be a capacitive sensor. Four capacitive sensors are respectively arranged on the left front, right front, left rear and right rear of the cleaning robot to detect the surrounding environment.
S122:判断是否能够在清扫区域范围内绕过障碍。S122: Determine whether the obstacle can be bypassed within the cleaning area.
在检测到清扫区域存在障碍物时,判断在清扫区域的范围内是否能够绕过该障碍物继续执行清扫任务。若不能,执行步骤S123。When it is detected that there is an obstacle in the cleaning area, it is determined whether the obstacle can be bypassed within the scope of the cleaning area and the cleaning task can be continued. If not, go to step S123.
S123:执行报警提示。S123: Execute an alarm prompt.
在判断不能在清扫区域的范围内绕过障碍物时,向用户终端或上级控制端进行报警提示,以提醒人员对该障碍物存在的区域进行检查和清理。When it is judged that the obstacle cannot be bypassed within the scope of the cleaning area, an alarm prompt is sent to the user terminal or the upper-level control terminal to remind the personnel to check and clean the area where the obstacle exists.
该实施例为清扫机器人在自动控制下时遇到障碍物时的处理步骤。This embodiment is a processing step when the cleaning robot encounters an obstacle under automatic control.
在另一实施例中,清扫机器人在遇到障碍物时也能够转为人工控制。当机器人检测到清扫区域上存在障碍时,停止工作并向用户终端或上级控制端进行报警提示。在清扫机器人接收到向非障碍物区域的其他方向继续前进的指令时,会解除报警继续执行清扫任务。In another embodiment, the cleaning robot can also switch to manual control when encountering obstacles. When the robot detects that there is an obstacle in the cleaning area, it will stop working and give an alarm to the user terminal or the upper-level control terminal. When the cleaning robot receives an instruction to move forward in other directions in the non-obstacle area, it will cancel the alarm and continue to perform the cleaning task.
如图14所示,图14为本申请清扫机器人控制方法第十三实施例的流程示意图。该实施例是对步骤S13的进一步扩展。其包括以下步骤:As shown in FIG. 14 , FIG. 14 is a schematic flowchart of the thirteenth embodiment of the cleaning robot control method of the present application. This embodiment is a further extension of step S13. It includes the following steps:
S131:检测是否存在出入库定位装置。S131: Detecting whether there is a warehouse-in-out positioning device.
在清扫机器人入库时,为使机器人准确的停止在预设的停放位置上,在机器人库的停放位置设置有一出入库定位装置。该装置可以是位于停放位置尾部的一金属片,能够被清扫机器人尾部的霍尔传感器所检测,以提示清扫机器人到达指定位置。When the cleaning robot is put into the warehouse, in order to make the robot stop at the preset parking position accurately, a warehouse-in-out positioning device is provided at the parking position of the robot library. The device can be a metal piece located at the tail of the parking position, which can be detected by a Hall sensor at the tail of the cleaning robot to prompt the cleaning robot to reach the designated position.
S132:开启充电开关对机器人充电。S132: Turn on the charging switch to charge the robot.
在检测到出入库定位装置时,清扫机器人停止运动,停放于指定的位置。此时打开充电开关以对清扫机器人进行充电。When detecting the in-out and out-of-warehouse positioning device, the cleaning robot stops moving and parks at the designated position. At this time, turn on the charging switch to charge the cleaning robot.
在一实施例中,在检测到出入库装置,清扫机器人停止后,延迟一段时间后再打开充电开关对机器人进行充电,以保证操作的安全性。In one embodiment, after a storage-in/out device is detected and the cleaning robot stops, the charging switch is turned on to charge the robot after a delay, so as to ensure the safety of the operation.
如图15所示,图15为本申请清扫机器人控制方法第十四实施例的流程示意图。该实施例是对第十三实施例的进一步扩展。其包括以下步骤:As shown in FIG. 15 , FIG. 15 is a schematic flowchart of a fourteenth embodiment of a cleaning robot control method of the present application. This embodiment is a further extension of the thirteenth embodiment. It includes the following steps:
S141:检测充电电流是否有效。S141: Detect whether the charging current is valid.
在清扫机器人进行充电的过程中,对该充电电流进行检测,判断充电电流是否有效。当充电电流大于某一预设值时,才能判定充电有效。During the charging process of the cleaning robot, the charging current is detected to determine whether the charging current is valid. Only when the charging current is greater than a certain preset value can it be determined that the charging is valid.
更进一步地,当充电电流大于某一预设值且持续了一定的时间,才能判定为充电有效。Further, when the charging current is greater than a certain preset value and lasts for a certain period of time, it can be determined that the charging is valid.
S142:执行报警提示。S142: Execute an alarm prompt.
若未检测到充电电流,或充电电流小于预设值,或大于预设值但未持续一定的时间,都判定为充电无效,向用户终端或上级控制端进行报警提示。If the charging current is not detected, or the charging current is less than the preset value, or greater than the preset value but does not last for a certain period of time, it is determined that the charging is invalid, and an alarm prompt is sent to the user terminal or the upper-level control terminal.
如图16所示,图16为本申请电子设备一实施例的结构示意图。As shown in FIG. 16 , FIG. 16 is a schematic structural diagram of an embodiment of an electronic device of the present application.
该电子设备包括处理器110和存储器120。The electronic device includes a
处理器110控制电子设备的操作,处理器110还可以称为CPU(Central ProcessingUnit,中央处理单元)。处理器110可能是一种集成电路芯片,具有信号序列的处理能力。处理器110还可以是通用处理器、数字信号序列处理器(DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The
存储器120存储处理器110工作所需要的指令和程序数据。The
处理器110用于执行指令以实现本申请前述清扫机器人控制方法的任一实施例及可能的组合所提供的方法。The
如图17所示,图17为本申请计算机可读存储装置一实施例的结构示意图。As shown in FIG. 17 , FIG. 17 is a schematic structural diagram of an embodiment of a computer-readable storage device of the present application.
本申请可读存储装置一实施例包括存储器210,存储器210存储有程序数据,该程序数据被执行时实现本申请清扫机器人控制方法任一实施例及可能的组合所提供的方法。An embodiment of the readable storage device of the present application includes a
存储器210可以包括U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等可以存储程序指令的介质,或者也可以为存储有该程序指令的服务器,该服务器可将存储的程序指令发送给其他设备运行,或者也可以自运行该存储的程序指令。The
如图18所示,图18为本申请机器人控制系统一实施例的结构示意图。As shown in FIG. 18 , FIG. 18 is a schematic structural diagram of an embodiment of the robot control system of the present application.
该机器人控制系统包括至少一机器人310,如电子设备实施例中所描述的电子设备320、一机器人库330。The robot control system includes at least one
该机器人310可包括多种模块。例如定位模块,用于实时更新机器人的位置信息;传感器模块,用于接收相应传感器的感知数据;地图模块,用于存储周围地理环境的地图信息,设定清扫区域,规划路线;基站模块,用于辅助进行更精准的定位;上位机模块,用于记录运行相关数据,获取相应指令等等。The
感知模块可包括电容传感器,分别在清扫机器人的左前方、右前方、左后方、右后方设置电容传感器用于检测行驶周围是否存在障碍区域;磁条传感器,安装在清扫机器人下方,用于入库时对磁条进行检测以进行磁条导航;霍尔传感器,安装于清扫机器人尾部,用于检测作为出入库定位装置的金属片,以保证清扫机器人的停放位置准确。The perception module may include capacitive sensors, which are respectively installed on the left front, right front, left rear, and right rear of the cleaning robot to detect whether there are obstacles around the driving area; magnetic strip sensors are installed under the cleaning robot for storage. The magnetic strip is detected for magnetic strip navigation; the Hall sensor is installed at the tail of the cleaning robot and is used to detect the metal sheet as the positioning device for in and out of the warehouse, so as to ensure the accurate parking position of the cleaning robot.
机器人310与电子设备320通信连接,该电子设备320包括处理器和存储器。
处理器控制电子设备的操作,处理器还可以称为CPU(Central Processing Unit,中央处理单元)。处理器可能是一种集成电路芯片,具有信号序列的处理能力。处理器还可以是通用处理器、数字信号序列处理器(DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The processor controls the operation of the electronic device, and the processor may also be called a CPU (Central Processing Unit, central processing unit). A processor may be an integrated circuit chip that has the ability to process signal sequences. The processor may also be a general purpose processor, digital signal sequence processor (DSP), application specific integrated circuit (ASIC), field programmable gate array (FPGA) or other programmable logic device, discrete gate or transistor logic device, discrete hardware component . A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like.
存储器存储处理器工作所需要的指令和程序数据。The memory stores the instructions and program data required for the operation of the processor.
处理器用于执行指令以实现本申请前述清扫机器人控制方法的任一实施例及可能的组合所提供的方法。The processor is configured to execute the instructions to implement the method provided by any one of the embodiments and possible combinations of the foregoing cleaning robot control methods of the present application.
机器人库330设置有入库线、出库线以及出入库定位装置。The
其中,入库线长于出库线,入库线、出库线以及出入库定位装置用于引导机器人310完成出入库。The inbound line is longer than the outbound line, and the inbound line, the outbound line and the inbound and outbound positioning device are used to guide the
该机器人控制系统还可以包括基站,实现对于清扫机器人更加精准的定位。The robot control system may further include a base station to achieve more precise positioning of the cleaning robot.
综上所述,本申请通过使用两种导航模块引导清扫机器人。第一导航模式引导清扫机器人出库以及帮助清扫机器人定位,使其在对应的清扫区域中完成清扫任务,而第二导航模式与第一导航模式相配合引导清扫机器人入库。第二导航模式为磁条导航模式,是一种基于场地中预先设置的磁条进行导航的控制模式,由于是根据实地设置的物体进行导航,因此磁条导航能够精准地将清扫机器人引导至入库时的指定位置。两导航模式的相互配合使得清扫机器人能够自行完成出入库操作,并在入库时达到指定位置,从而能够开启充电等续航操作,进而继续进行下一次的清扫任务的执行,使得清扫机器人能够自行完成多个清扫任务或长时间的清扫任务而无需人工操作。To sum up, the present application guides the cleaning robot by using two kinds of navigation modules. The first navigation mode guides the cleaning robot out of the warehouse and helps the cleaning robot to locate it so that it can complete the cleaning task in the corresponding cleaning area, while the second navigation mode cooperates with the first navigation mode to guide the cleaning robot into the warehouse. The second navigation mode is the magnetic stripe navigation mode, which is a control mode for navigation based on the magnetic stripe preset in the field. Since the navigation is based on the objects set in the field, the magnetic stripe navigation can accurately guide the cleaning robot to the entrance. The specified location when the library is used. The cooperation of the two navigation modes enables the cleaning robot to complete the operation of entering and leaving the warehouse by itself, and reaches the designated position when entering the warehouse, so that it can start the battery life operation such as charging, and then continue to perform the next cleaning task, so that the cleaning robot can complete it by itself Multiple cleaning tasks or long cleaning tasks without manual operation.
在本申请所提供的几个实施方式中,应该理解到,所揭露的方法以及设备,可以通过其它的方式实现。例如,以上所描述的设备实施方式仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。In the several embodiments provided in this application, it should be understood that the disclosed method and device may be implemented in other manners. For example, the device implementations described above are only illustrative. For example, the division of the modules or units is only a logical function division. In actual implementation, there may be other divisions. For example, multiple units or components may be Incorporation may either be integrated into another system, or some features may be omitted, or not implemented.
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施方式方案的目的。The units described as separate components may or may not be physically separated, and components displayed as units may or may not be physical units, that is, may be located in one place, or may be distributed to multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the solution in this implementation manner.
另外,在本申请各个实施方式中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, or each unit may exist physically alone, or two or more units may be integrated into one unit. The above-mentioned integrated units may be implemented in the form of hardware, or may be implemented in the form of software functional units.
上述其他实施方式中的集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)或处理器(processor)执行本申请各个实施方式所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,RandomAccess Memory)、磁碟或者光盘等各种可以存储程序代码的介质。If the integrated units in the above-mentioned other embodiments are implemented in the form of software functional units and sold or used as independent products, they may be stored in a computer-readable storage medium. Based on this understanding, the technical solutions of the present application can be embodied in the form of software products in essence, or the parts that contribute to the prior art, or all or part of the technical solutions, and the computer software products are stored in a storage medium , including several instructions for causing a computer device (which may be a personal computer, a server, or a network device, etc.) or a processor to execute all or part of the steps of the methods described in the various embodiments of the present application. The aforementioned storage medium includes: U disk, removable hard disk, Read-Only Memory (ROM, Read-Only Memory), Random Access Memory (RAM, Random Access Memory), magnetic disk or optical disk and other media that can store program codes.
以上所述仅为本申请的实施例,并非因此限制本申请的专利范围,凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本申请的专利保护范围内。The above descriptions are only the embodiments of the present application, and are not intended to limit the scope of the patent of the present application. Any equivalent structure or equivalent process transformation made by using the contents of the description and drawings of the present application, or directly or indirectly applied to other related technologies Fields are similarly included within the scope of patent protection of this application.
Claims (17)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210216565.8A CN114603556B (en) | 2022-03-07 | 2022-03-07 | Robot control method, control system, electronic device and readable storage device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210216565.8A CN114603556B (en) | 2022-03-07 | 2022-03-07 | Robot control method, control system, electronic device and readable storage device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114603556A true CN114603556A (en) | 2022-06-10 |
| CN114603556B CN114603556B (en) | 2025-01-10 |
Family
ID=81861783
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210216565.8A Active CN114603556B (en) | 2022-03-07 | 2022-03-07 | Robot control method, control system, electronic device and readable storage device |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114603556B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN116069021A (en) * | 2022-12-16 | 2023-05-05 | 珠海格力智能装备有限公司 | AGV navigation tape reliability judgment method, device, system and electronic equipment |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2003029830A (en) * | 2001-07-12 | 2003-01-31 | Amano Corp | Guidance system for cleaning robot using acoustic signal |
| US20040111184A1 (en) * | 2002-09-13 | 2004-06-10 | Chiappetta Mark J. | Navigational control system for a robotic device |
| CN110202570A (en) * | 2019-05-13 | 2019-09-06 | 深圳创动科技有限公司 | Robot and its motion control method and storage medium |
| CN110281233A (en) * | 2019-05-13 | 2019-09-27 | 深圳创动科技有限公司 | Robot, robot control system and motion control method and storage medium |
| CN113659652A (en) * | 2021-07-20 | 2021-11-16 | 深圳创动科技有限公司 | Robot charging method, robot and robot system |
-
2022
- 2022-03-07 CN CN202210216565.8A patent/CN114603556B/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2003029830A (en) * | 2001-07-12 | 2003-01-31 | Amano Corp | Guidance system for cleaning robot using acoustic signal |
| US20040111184A1 (en) * | 2002-09-13 | 2004-06-10 | Chiappetta Mark J. | Navigational control system for a robotic device |
| CN110202570A (en) * | 2019-05-13 | 2019-09-06 | 深圳创动科技有限公司 | Robot and its motion control method and storage medium |
| CN110281233A (en) * | 2019-05-13 | 2019-09-27 | 深圳创动科技有限公司 | Robot, robot control system and motion control method and storage medium |
| CN113659652A (en) * | 2021-07-20 | 2021-11-16 | 深圳创动科技有限公司 | Robot charging method, robot and robot system |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN116069021A (en) * | 2022-12-16 | 2023-05-05 | 珠海格力智能装备有限公司 | AGV navigation tape reliability judgment method, device, system and electronic equipment |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114603556B (en) | 2025-01-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20240077885A1 (en) | Automatic working system, self-moving device, and methods for controlling same | |
| US9573275B2 (en) | Navigation for a robotic working tool | |
| EP3237927B1 (en) | Improved navigation for a robotic work tool | |
| EP3230815B1 (en) | Improved navigation for a robotic working tool | |
| EP3770711B1 (en) | Method for repositioning robot | |
| EP3673338B1 (en) | Improved work area marking for a robotic working tool | |
| CN109407675B (en) | Obstacle avoidance method and chip for robot returning seat and autonomous mobile robot | |
| EP3236734B1 (en) | Improved operation of a robotic work tool by adapting the operation to weather conditions | |
| CN112445221B (en) | Automatic working system and regression method | |
| US20110125358A1 (en) | Control method for a robot vehicle, and robot vehicle | |
| CN108415432A (en) | Localization method of the robot based on straight flange | |
| EP4075226B1 (en) | Self-moving device and working method therefor | |
| CN112220413B (en) | Method and device for detecting slippage of sweeping robot and readable storage medium | |
| CN111240308A (en) | Method and device for detecting repeated obstacle, electronic equipment and readable storage medium | |
| CN114603556A (en) | Robot control method, control system, electronic device and readable storage device | |
| CN117193331A (en) | Recharging path planning method and device, self-mobile device and readable storage medium | |
| CN115123216A (en) | Vehicle obstacle avoidance method, device, vehicle, equipment and storage medium | |
| WO2024051733A1 (en) | Self-moving robot control system, mapping method, docking station entering method and docking station exiting method | |
| CN118732685A (en) | Method, system, medium and equipment for automatic navigation and walking of pipeline inspection robot | |
| CN117570827A (en) | Recharge positioning method, system, mobile device and readable storage medium | |
| CN114063611A (en) | Robot charging connection method and device, robot and storage medium | |
| Takauji et al. | Intelligent control method for autonomous vehicle by fuzzy-neural network and self-position-azimuth correction | |
| CN114903372A (en) | Method for returning self-moving robot to base station and self-moving robot | |
| CN116907527A (en) | Underground space navigation charging method and device, electronic equipment and storage medium | |
| CN120370902A (en) | Method and system for identifying inside and outside of working area by garden robot |
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 | ||
| CB03 | Change of inventor or designer information |
Inventor after: Mo Yule Inventor after: Sun Chengman Inventor after: Wang Yin Inventor before: Yule Inventor before: Sun Chengman Inventor before: Wang Yin |
|
| CB03 | Change of inventor or designer information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |