Control method and device of mobile robot, readable storage medium and robot
The second robot is controlled by the server to obtain the first robot's trapping information and generate the trapping map, which solves the problem that the wheeled robot is difficult to get out of obstacles on its own, and improves the success rate of escape and the accuracy of obstacle recognition.
Patent Information
- Application Number
- CN202310488161.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-04
- Publication Date
- 2024-11-08
AI Technical Summary
Wheeled robots find it difficult to get out of trouble on their own when encountering obstacles, resulting in a low success rate of escape. The existing technology cannot accurately sense the location of obstacles, affecting the robot's continued progress.
The second robot is controlled by the server to obtain the first robot's trapping information, assist the first robot to get out of trouble, use image sensors and sensor data to determine the trapping situation, and generate a trapping map to help the first robot plan the route to escape.
It improves the success rate of robots to escape from obstacles and ensures that the robot can effectively identify the location and shape of obstacles, so as to escape from obstacles independently.
Smart Images

Figure CN118915706A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot control technology, and in particular to a control method and device for a mobile robot, a readable storage medium and a robot. Background Art
[0002] In the related art, when a wheeled robot, such as a sweeping robot, is working, it may be disturbed by obstacles, causing it to be unable to continue moving along a set route, causing the robot to be trapped.
[0003] When a robot is trapped, it usually relies on the detection results of its own sensors to determine the situation. However, when a robot is trapped, it cannot move freely and therefore cannot effectively sense the location of obstacles, resulting in inaccurate judgment of the situation and a low success rate for the robot to escape. Summary of the invention
[0004] The present invention aims to solve at least one of the technical problems existing in the prior art or related art.
[0005] To this end, a first aspect of the present invention provides a control method for a mobile robot.
[0006] A second aspect of the present invention provides a control method for a mobile robot.
[0007] A third aspect of the present invention provides a control device for a mobile robot.
[0008] A fourth aspect of the present invention provides a control device for a mobile robot.
[0009] A fifth aspect of the present invention provides a control device for a mobile robot.
[0010] A sixth aspect of the present invention provides a readable storage medium.
[0011] A seventh aspect of the present invention provides a robot.
[0012] In view of this, a first aspect of the present invention provides a control method for a mobile robot, which is applied to a server. The control method includes:
[0013] Obtain a trapped signal of the first robot; based on the trapped signal, control the second robot to obtain the stuck information of the first robot; based on the stuck information, control the second robot to perform an auxiliary escape operation to assist the first robot in escaping.
[0014] In this technical solution, the first robot is a robot that is performing a work task, such as a sweeping robot that is performing an indoor cleaning task.
[0015] When the first robot is blocked by an obstacle, the first robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the first robot fails to cross the obstacle or bypass the obstacle for many times, the first robot determines that it has entered a trapped state, and at this time, the first robot sends a trapped signal to the server.
[0016] Exemplarily, the trapped signal carries information such as the trapped state, location information, and identification information of the first robot.
[0017] The server can be a cloud server, a robot base station, or a device such as an intelligent gateway that establishes a wireless network connection with the robot.
[0018] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0019] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0020] In addition, the robot control method in the above technical solution provided by the present invention may also have the following additional technical features:
[0021] In the above technical solution, after the step of obtaining the trapped signal of the first robot, the control method further includes:
[0022] Determine the position information of the first robot according to the trapped signal; determine the second robot; send an escape signal to the second robot, the escape signal including the position information; control the second robot to move to the position included in the position information.
[0023] In this technical solution, after receiving the distress signal from the first robot, the server confirms the identity and location information of the first robot according to the information carried in the distress signal.
[0024] The server finds the second robot according to the location information carried in the trapped signal. The second robot may be another one of the parent-child robots working in cooperation with the first robot, such as the first robot is a sweeping robot and the second robot is a mopping robot.
[0025] The second robot may also be another robot in the same working area as the first robot, such as another cleaning robot, a service robot, a monitoring robot, etc.
[0026] After finding the second robot, the server sends an escape signal to the second robot, and the escape signal carries the location information of the trapped first robot.
[0027] After receiving the escape signal, the second robot determines the trapped position of the first robot according to the escape signal, and moves to the vicinity of the trapped position of the first robot according to the position information carried in the escape signal.
[0028] In any of the above technical solutions, controlling the second robot to obtain the stuck information of the first robot includes:
[0029] Control the second robot to move to at least one target position, where the at least one target position is related to the position included in the position information; control the second robot to obtain image data or sensor data of the at least one target position; and control the second robot to determine the jamming information based on the image data or the sensor data.
[0030] In this technical solution, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, and the target position is related to the position information in the trapped signal, specifically, near the trapped position of the first robot.
[0031] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0032] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0033] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0034] Exemplarily, the second robot moves around the first robot, and at the same time collects stuck information around the first robot through its own camera or sensors such as laser radar.
[0035] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0036] In any of the above technical solutions, the jamming information includes obstacle information, the jamming location and / or jamming direction of the first robot.
[0037] In this technical solution, the obstacle information specifically refers to obstacles that cause the robot to get stuck, such as corners, debris on the ground, furniture, etc.
[0038] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0039] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0040] According to the stuck information, it is possible to reversely infer the escape route in the time domain that helps the first robot escape, thereby improving the success rate of escaping.
[0041] In any of the above technical solutions, based on the stuck information, controlling the second robot to perform an auxiliary escape operation to assist the first robot in escaping includes:
[0042] According to the obstacle information, the stuck position and / or stuck direction of the first robot, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping. The auxiliary escape operation is determined based on the obstacle information, the stuck position and / or stuck direction of the first robot.
[0043] In this technical solution, the second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot. The auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0044] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0045] Sending the escape route to the first robot can effectively help the first robot escape.
[0046] In any of the above technical solutions, according to the obstacle information, the stuck position and / or stuck direction of the first robot, controlling the second robot to perform the auxiliary escape operation includes:
[0047] The second robot is controlled to generate a jam map of the first robot according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0048] In this technical solution, the second robot relies on its own mapping capability to construct a jam map near the first robot based on the jam information near the first robot, including obstacle information, the jam location and / or jam direction of the first robot.
[0049] The stuck map can help the first robot understand the location, shape, height and other information of the surrounding obstacles, so as to plan an escape route in a targeted manner. The trapped first robot can carry out escape movements in a targeted manner according to the planned escape route, which can effectively improve the escape efficiency.
[0050] Exemplarily, the stuck map may be grid map information including obstacle information.
[0051] An embodiment of the present invention provides a collaborative escape method between multiple robots, in which non-trapped robots collect stuck information near a trapped robot and generate a stuck map. The trapped robot plans an escape route in a targeted manner based on the stuck map, thereby effectively escaping from the trapped state based on the escape route, thereby improving the success rate of the robot's escape.
[0052] In any of the above technical solutions, based on the stuck information, the step of controlling the second robot to perform an assisting escape operation to assist the first robot in escaping includes:
[0053] A first escape signal is sent to the second robot, wherein the first escape signal includes position information; the second robot is controlled to move to a position included in the position information; and the second robot is controlled to perform an auxiliary escape operation.
[0054] In this technical solution, after receiving the distress signal from the first robot, the server confirms the identity and location information of the first robot according to the information carried in the distress signal.
[0055] The server searches for the second robot based on the location information carried in the trapped signal. In some implementations, the server may also determine the second robot based on the user's selection input.
[0056] The second robot may be another one of the parent-child robots that cooperate with the first robot, such as the first robot is a sweeping robot and the second robot is a mopping robot.
[0057] The second robot may also be another robot in the same working area as the first robot, such as another cleaning robot, a service robot, a monitoring robot, etc.
[0058] After finding the second robot, the server sends an escape signal to the second robot, specifically a first escape signal, and the first escape signal carries the location information of the trapped first robot.
[0059] After receiving the first escape signal, the second robot determines the trapped position of the first robot according to the first escape signal, and moves to the vicinity of the trapped position of the first robot according to the position information carried in the first escape signal.
[0060] After the second robot arrives at the trapped location of the first robot, the second robot determines the actual location of the first robot based on the identity information of the first robot and its own robot vision sensor, such as a camera or a lidar.
[0061] After determining the actual position of the first robot, the second robot moves to the vicinity of the first robot and performs an auxiliary escape operation to assist the first robot in escaping from the trap.
[0062] In the embodiment of the present invention, a second robot that is not trapped assists a first robot that is trapped in getting out of trouble, thereby improving the success rate of the robots getting out of trouble.
[0063] In any of the above technical solutions, the step of controlling the second robot to perform the auxiliary escape operation includes: controlling the second robot to apply a thrust to the first robot along a first direction.
[0064] In this technical solution, when controlling the second robot to perform an auxiliary escape operation, the second robot is controlled to move to the first side of the first robot, wherein the first side of the first robot is specifically the tail or head of the first robot, and the second robot applies a thrust to the first robot along the first direction.
[0065] Exemplarily, the first direction can be the walking direction of the first robot, that is, the second robot applies a thrust to the first robot from the tail to the head of the first robot. At this time, the first robot can also drive the running wheels to rotate at the same time, combining the first robot's own movement ability and the auxiliary thrust of the second robot to help the first robot cross the obstacle, so that the trapped first robot can successfully escape.
[0066] The embodiment of the present invention provides a collaborative escape method among multiple robots, wherein an untrapped robot applies a thrust to a trapped robot to help the trapped robot escape from the trapped state, thereby improving the success rate of the robot's escape.
[0067] In any of the above technical solutions, determining the second robot includes:
[0068] Determine at least one candidate robot; determine a distance value between each candidate robot in the at least one candidate robot and the first robot; and determine a second robot in the at least one candidate robot according to the distance value.
[0069] In this technical solution, the server determines an alternative robot based on the trapped location information of the first robot, and the alternative robot is a robot in the same area as the trapped location of the first robot, such as a robot in the living room.
[0070] After determining at least one candidate robot in the same area, the server further determines the distance value between each candidate robot and the first robot according to the position information of the candidate robots and the trapped position of the first robot.
[0071] The server selects an alternative robot that is closer to the first robot as the second robot based on the distance between the alternative robot and the first robot, and sends an escape signal to the second robot. After receiving the escape signal, the second robot moves to the trapped location of the first robot and helps the first robot escape.
[0072] The embodiment of the present invention selects a robot for helping a trapped robot to escape according to the distance information between the trapped robot and the trapped position, thereby improving the efficiency of escaping the robot.
[0073] In any of the above technical solutions, determining at least one candidate robot includes:
[0074] N standby robots in a standby state are determined, where N is a positive integer; and among the N standby robots, at least one candidate robot whose distance value to the first robot is less than a first threshold is determined.
[0075] In this technical solution, after receiving the trapped signal of the first robot, the server first obtains N standby robots that are currently in standby state and can be called by the server. The standby state specifically means that the robot has no task or work being performed and can be called by the server.
[0076] After determining the N standby robots that can be called, the server further determines the distance value between each of the N standby robots and the trapped first robot. According to the N distance values between the N standby robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a first threshold are selected.
[0077] The embodiment of the present invention uses a robot in a standby state whose distance to the trapped location of the first robot is less than a first threshold as a backup robot, which can avoid interrupting the work progress of the robot in a working state and improve the success rate of the robot's escape while ensuring that the robot's work task is not affected.
[0078] In any of the above technical solutions, determining at least one candidate robot includes:
[0079] M online robots in an online state are determined, where M is a positive integer; and among the M online robots, at least one candidate robot whose distance value to the first robot is less than a second threshold is determined.
[0080] In this technical solution, a robot in an online state is a robot that can be called by a server. Specifically, when the robot is in an online state, the robot can exchange data with a host computer or a server through a gateway, and the server can call the online robot to perform the corresponding task by sending a control signal.
[0081] On the other hand, if the robot is in an offline state, it means that the robot is turned off or disconnected from the network, and the robot cannot receive control signals from the server or host computer.
[0082] After receiving the trapped signal of the first robot, the server first obtains a device list of robots currently in an online state to obtain M online robots.
[0083] Then the server further determines the distance value between each of the M online robots and the trapped first robot. According to the M distance values between the M online robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a second threshold are selected.
[0084] The embodiment of the present invention selects the robots whose distance values from the trapped location of the first robot are less than a second threshold among the online standby robots as candidate robots, so as to select as many candidate robots as possible and improve the success rate of the robots' escape.
[0085] In any of the above technical solutions, determining the second robot from at least one candidate robot according to the distance value includes:
[0086] The candidate robot with the smallest distance value is determined as the second robot.
[0087] In this technical solution, the candidate robot that is closest to the trapped first robot is determined as the second robot, thereby ensuring that the second robot can reach the trapped location of the first robot as soon as possible, thereby improving the efficiency of the robot's escape.
[0088] A second aspect of the present invention provides a control method for a mobile robot, which is applied to the robot. The control method comprises:
[0089] When an escape signal is received from the server, the position information of the trapped robot is determined according to the escape signal; based on the position information, the jamming information corresponding to the trapped robot is obtained; and the auxiliary escape operation is performed according to the jamming information.
[0090] In this technical solution, when the robot is performing a task, if the robot is blocked by an obstacle and cannot escape by itself, the robot will send a trapped signal to the server. After receiving the trapped signal, the server determines the trapped area of the trapped robot based on the location information carried in the trapped signal.
[0091] The server may be a cloud server, a robot base station, or a smart gateway that establishes a wireless network connection with the robot.
[0092] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0093] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0094] In the above technical solution, obtaining the stuck information corresponding to the trapped robot according to the position information includes:
[0095] Move to at least one target position, the at least one target position is related to the position included in the position information; determine the stuck information based on the image data or sensor data of the at least one target position
[0096] In this technical solution, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, and the target position is related to the position information in the trapped signal, specifically, near the trapped position of the first robot.
[0097] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0098] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0099] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0100] Exemplarily, the second robot moves around the first robot, and at the same time collects stuck information around the first robot through its own camera or sensors such as laser radar.
[0101] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0102] In any of the above technical solutions, the jamming information includes obstacle information, a jamming location and / or a jamming direction of the first robot; performing an auxiliary escape operation according to the jamming information includes:
[0103] A jam map of the first robot is generated according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0104] In this technical solution, the obstacle information specifically refers to obstacles that cause the robot to get stuck, such as corners, debris on the ground, furniture, etc.
[0105] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0106] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0107] The second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot, wherein the auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0108] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0109] Sending the escape route to the first robot can effectively help the first robot escape.
[0110] In any of the above technical solutions, the control method further includes:
[0111] When the robot is detected to be in a trapped state, a trapped signal is sent to the server; when a trapped map is received from the server or other robots, an escape route is determined according to the trapped map; and an escape movement is performed according to the escape route.
[0112] In this technical solution, when the robot is performing a task, if the robot is blocked by an obstacle, the robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the robot fails to cross the obstacle or bypass the obstacle several times, the robot determines that it has entered a trapped state, and at this time the robot sends a trapped signal to the server.
[0113] After receiving the trapped signal, the server will find other robots that can help the current robot escape based on the location information carried in the trapped signal. The robot that receives the escape signal will go to the area where the trapped robot is located based on the location information, and collect the trapped information near the trapped robot, and generate a corresponding trapped map through its own mapping capabilities.
[0114] The robot assisting in escaping can send the generated stuck map to the server, and the server sends the stuck map to the trapped robot. The robot assisting in escaping can also directly send the stuck map directly to the trapped robot through the wireless network connection between the robot and the trapped robot.
[0115] Since the trapped map records the information of objects within a certain range near the trapped robot, it also includes information such as the location, shape, and height of obstacles. Therefore, the trapped robot can understand the location, shape, and height of surrounding obstacles based on the received trapped map, thereby planning an escape route in a targeted manner and performing escape movements according to the escape route.
[0116] An embodiment of the present invention provides a collaborative escape method between multiple robots, in which non-trapped robots collect stuck information near a trapped robot and generate a stuck map. The trapped robot plans an escape route in a targeted manner based on the stuck map, thereby effectively escaping from the trapped state based on the escape route, thereby improving the success rate of the robot's escape.
[0117] A third aspect of the present invention provides a control device for a mobile robot, which is applied to a server, and the control device includes:
[0118] An acquisition module, used for acquiring a trapped signal of the first robot;
[0119] The control module is used to control the second robot to obtain the jamming information of the first robot based on the jamming signal; based on the jamming information, control the second robot to perform auxiliary escape operation to assist the first robot to escape.
[0120] In this technical solution, the first robot is a robot that is performing a work task, such as a sweeping robot that is performing an indoor cleaning task.
[0121] When the first robot is blocked by an obstacle, the first robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the first robot fails to cross the obstacle or bypass the obstacle for many times, the first robot determines that it has entered a trapped state, and at this time, the first robot sends a trapped signal to the server.
[0122] Exemplarily, the trapped signal carries information such as the trapped state, location information, and identification information of the first robot.
[0123] The server can be a cloud server, a robot base station, or a device such as an intelligent gateway that establishes a wireless network connection with the robot.
[0124] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0125] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0126] A fourth aspect of the present invention provides a control device for a mobile robot, which is applied to the robot, and the control device comprises:
[0127] A determination module, configured to determine the position information of the trapped robot according to the escape signal when receiving the escape signal from the server;
[0128] An acquisition module, used to acquire the jamming information corresponding to the trapped robot according to the position information;
[0129] The execution module is used to perform auxiliary escape operations according to the stuck information.
[0130] In this technical solution, when the robot is performing a task, if the robot is blocked by an obstacle and cannot escape by itself, the robot will send a trapped signal to the server. After receiving the trapped signal, the server determines the trapped area of the trapped robot based on the location information carried in the trapped signal.
[0131] The server may be a cloud server, a robot base station, or a smart gateway that establishes a wireless network connection with the robot.
[0132] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0133] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0134] The fifth aspect of the present invention provides a control device for a mobile robot, comprising: a memory for storing programs or instructions; a processor for implementing the steps of the control method for the mobile robot provided in any of the above-mentioned technical solutions when executing the programs or instructions, and therefore also including all its beneficial effects, which will not be described here to avoid repetition.
[0135] The sixth aspect of the present invention provides a readable storage medium having a program or instruction stored thereon. When the program or instruction is executed by a processor, the steps of the mobile robot control method provided in any of the above technical solutions are implemented, and therefore all its beneficial effects are also included. To avoid repetition, they will not be repeated here.
[0136] The seventh aspect of the present invention provides a robot, including a control device for a mobile robot as provided in any of the above technical solutions; and / or a readable storage medium as provided in any of the above technical solutions, and therefore also includes all its beneficial effects, which will not be repeated here to avoid repetition. BRIEF DESCRIPTION OF THE DRAWINGS
[0137] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:
[0138] Figure 1 A flowchart of a method for controlling a mobile robot according to an embodiment of the present invention is shown;
[0139] Figure 2 A schematic diagram showing a robot acquiring stuck information according to an embodiment of the present invention;
[0140] Figure 3 A schematic diagram of a stuck map according to an embodiment of the present invention is shown;
[0141] Figure 4 A schematic diagram of robot control according to an embodiment of the present invention is shown;
[0142] Figure 5A second flowchart of a method for controlling a mobile robot according to an embodiment of the present invention is shown;
[0143] Figure 6 shows one of the structural block diagrams of the control device of the mobile robot according to an embodiment of the present invention;
[0144] Figure 7 A second structural block diagram of the control device for a mobile robot according to an embodiment of the present invention is shown;
[0145] Figure 8 A third structural block diagram of the control device for a mobile robot according to an embodiment of the present invention is shown. DETAILED DESCRIPTION
[0146] In order to more clearly understand the above-mentioned purpose, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.
[0147] In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention may also be implemented in other ways different from those described herein. Therefore, the protection scope of the present invention is not limited to the specific embodiments disclosed below.
[0148] Refer to the following Figures 1 to 8 The control method, device, readable storage medium and robot of the mobile robot according to some embodiments of the present invention are described.
[0149] In some embodiments of the present invention, a control method for a mobile robot is provided, which is applied to a server. Figure 1 FIG. 1 shows one of the flow charts of the control method of the mobile robot according to an embodiment of the present invention. Figure 1 As shown, the control method includes:
[0150] Step 102, obtaining a trapped signal of the first robot;
[0151] Step 104, based on the trapped signal, controlling the second robot to obtain the trapped information of the first robot;
[0152] Step 106: Based on the stuck information, control the second robot to perform an auxiliary escape operation to assist the first robot in escaping.
[0153] In an embodiment of the present invention, the first robot is a robot that is performing a work task, such as a sweeping robot that is performing an indoor cleaning task.
[0154] When the first robot is blocked by an obstacle, the first robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the first robot fails to cross the obstacle or bypass the obstacle for many times, the first robot determines that it has entered a trapped state, and at this time, the first robot sends a trapped signal to the server.
[0155] Exemplarily, the trapped signal carries information such as the trapped state, location information, and identification information of the first robot.
[0156] The server can be a cloud server, a robot base station, or a device such as an intelligent gateway that establishes a wireless network connection with the robot.
[0157] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0158] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0159] Based on any of the above embodiments, after the step of obtaining the trapped signal of the first robot, the control method further includes:
[0160] Determine the position information of the first robot according to the trapped signal; determine the second robot; send an escape signal to the second robot, the escape signal including the position information; control the second robot to move to the position included in the position information.
[0161] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, where the target position is related to the position information in the trapped signal, specifically near the trapped position of the first robot.
[0162] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0163] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0164] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0165] Exemplarily, the second robot moves around the first robot and collects stuck information around the first robot through its own camera or laser radar or other sensors. Figure 2 FIG. 4 is a schematic diagram showing a robot acquiring stuck information according to an embodiment of the present invention. Figure 2 As shown, the first robot 202 is trapped, and the second robot 204 moves to the vicinity of the first robot 202 and moves around the first robot 202 to collect the trapped information around the first robot 202.
[0166] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0167] Based on any of the above embodiments, the stuck information includes obstacle information, the stuck location and / or stuck direction of the first robot.
[0168] In the embodiment of the present invention, the obstacle information specifically refers to obstacles that cause the robot to be stuck, such as corners, debris on the ground, furniture, etc.
[0169] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0170] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0171] According to the stuck information, it is possible to reversely infer the escape route in the time domain that helps the first robot escape, thereby improving the success rate of escaping.
[0172] On the basis of any of the above embodiments, based on the stuck information, controlling the second robot to perform an assisting escape operation to assist the first robot in escaping includes:
[0173] According to the obstacle information, the stuck position and / or stuck direction of the first robot, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping. The auxiliary escape operation is determined based on the obstacle information, the stuck position and / or stuck direction of the first robot.
[0174] In an embodiment of the present invention, the second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot, wherein the auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0175] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0176] Sending the escape route to the first robot can effectively help the first robot escape.
[0177] On the basis of any of the above embodiments, according to the obstacle information, the stuck position and / or stuck direction of the first robot, controlling the second robot to perform the auxiliary escape operation includes:
[0178] The second robot is controlled to generate a jam map of the first robot according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0179] In an embodiment of the present invention, the second robot relies on its own mapping capability to construct a jam map near the first robot based on jam information near the first robot, including obstacle information, the jam location and / or jam direction of the first robot.
[0180] The stuck map can help the first robot understand the location, shape, height and other information of the surrounding obstacles, so as to plan an escape route in a targeted manner. The trapped first robot can carry out escape movements in a targeted manner according to the planned escape route, which can effectively improve the escape efficiency.
[0181] Exemplarily, the stuck map may be grid map information including obstacle information.
[0182] For example, Figure 3 FIG. 4 shows a schematic diagram of a card trap map according to an embodiment of the present invention. Figure 3 As shown, the stuck map 300 may be grid map information including obstacle information. The stuck map 300 specifically includes the position information of the first robot 302 and the obstacle 304 , and the first robot 302 plans an escape route according to the stuck map 300 .
[0183] An embodiment of the present invention provides a collaborative escape method between multiple robots, in which non-trapped robots collect stuck information near a trapped robot and generate a stuck map. The trapped robot plans an escape route in a targeted manner based on the stuck map, thereby effectively escaping from the trapped state based on the escape route, thereby improving the success rate of the robot's escape.
[0184] On the basis of any of the above embodiments, based on the stuck information, the step of controlling the second robot to perform an assisting escape operation to assist the first robot in escaping from the stuck state includes:
[0185] A first escape signal is sent to the second robot, wherein the first escape signal includes position information; the second robot is controlled to move to a position included in the position information; and the second robot is controlled to perform an auxiliary escape operation.
[0186] In the embodiment of the present invention, after receiving the distress signal from the first robot, the server confirms the identity and location information of the first robot according to the information carried in the distress signal.
[0187] The server searches for the second robot based on the location information carried in the trapped signal. In some implementations, the server may also determine the second robot based on the user's selection input.
[0188] The second robot may be another one of the parent-child robots that cooperate with the first robot, such as the first robot is a sweeping robot and the second robot is a mopping robot.
[0189] The second robot may also be another robot in the same working area as the first robot, such as another cleaning robot, a service robot, a monitoring robot, etc.
[0190] After finding the second robot, the server sends an escape signal to the second robot, specifically a first escape signal, and the first escape signal carries the location information of the trapped first robot.
[0191] After receiving the first escape signal, the second robot determines the trapped position of the first robot according to the first escape signal, and moves to the vicinity of the trapped position of the first robot according to the position information carried in the first escape signal.
[0192] After the second robot arrives at the trapped location of the first robot, the second robot determines the actual location of the first robot based on the identity information of the first robot and its own robot vision sensor, such as a camera or a lidar.
[0193] After determining the actual position of the first robot, the second robot moves to the vicinity of the first robot and performs an auxiliary escape operation to assist the first robot in escaping from the trap.
[0194] In the embodiment of the present invention, a second robot that is not trapped assists a first robot that is trapped to escape, thereby improving the success rate of the robots' escape.
[0195] Based on any of the above embodiments, the step of controlling the second robot to perform the auxiliary escape operation includes: controlling the second robot to apply a thrust to the first robot along a first direction.
[0196] In an embodiment of the present invention, when controlling the second robot to perform an auxiliary escape operation, the second robot is controlled to move to the first side of the first robot, wherein the first side of the first robot is specifically the tail or head of the first robot, and the second robot applies a thrust to the first robot along the first direction.
[0197] Exemplarily, the first direction can be the walking direction of the first robot, that is, the second robot applies a thrust to the first robot from the tail to the head of the first robot. At this time, the first robot can also drive the running wheels to rotate at the same time, combining the first robot's own movement ability and the auxiliary thrust of the second robot to help the first robot cross the obstacle, so that the trapped first robot can successfully escape.
[0198] For example, Figure 4 FIG. 4 shows a schematic diagram of robot control according to an embodiment of the present invention. Figure 4 As shown, the first robot 202 is trapped, and the second robot 204 moves to a first side of the first robot 202 and pushes the first robot 202 along a first direction.
[0199] The embodiment of the present invention provides a collaborative escape method among multiple robots, wherein an untrapped robot applies a thrust to a trapped robot to help the trapped robot escape from the trapped state, thereby improving the success rate of the robot's escape.
[0200] Based on any of the above embodiments, determining the second robot includes:
[0201] Determine at least one candidate robot; determine a distance value between each candidate robot in the at least one candidate robot and the first robot; and determine a second robot in the at least one candidate robot according to the distance value.
[0202] In the embodiment of the present invention, the server determines an alternative robot according to the trapped location information of the first robot, and the alternative robot is a robot in the same area as the trapped location of the first robot, such as a robot in the living room.
[0203] After determining at least one candidate robot in the same area, the server further determines the distance value between each candidate robot and the first robot according to the position information of the candidate robots and the trapped position of the first robot.
[0204] The server selects an alternative robot that is closer to the first robot as the second robot based on the distance between the alternative robot and the first robot, and sends an escape signal to the second robot. After receiving the escape signal, the second robot moves to the trapped location of the first robot and helps the first robot escape.
[0205] The embodiment of the present invention selects a robot for helping a trapped robot to escape according to the distance information between the trapped robot and the trapped position, thereby improving the efficiency of escaping the robot.
[0206] Based on any of the above embodiments, determining at least one candidate robot includes:
[0207] N standby robots in a standby state are determined, where N is a positive integer; and among the N standby robots, at least one candidate robot whose distance value to the first robot is less than a first threshold is determined.
[0208] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server first obtains N standby robots that are currently in standby state and can be called by the server. The standby state specifically means that the robot has no task or work being performed and can be called by the server.
[0209] After determining the N standby robots that can be called, the server further determines the distance value between each of the N standby robots and the trapped first robot. According to the N distance values between the N standby robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a first threshold are selected.
[0210] The embodiment of the present invention uses a robot in a standby state whose distance to the trapped location of the first robot is less than a first threshold as a backup robot, which can avoid interrupting the work progress of the robot in a working state and improve the success rate of the robot's escape while ensuring that the robot's work task is not affected.
[0211] Based on any of the above embodiments, determining at least one candidate robot includes:
[0212] M online robots in an online state are determined, where M is a positive integer; and among the M online robots, at least one candidate robot whose distance value to the first robot is less than a second threshold is determined.
[0213] In the embodiment of the present invention, the robot in the online state is a robot that can be called by the server. Specifically, when the robot is in the online state, the robot can exchange data with the host computer or server through the gateway, and the server can call the online robot to perform the corresponding task by sending a control signal.
[0214] On the other hand, if the robot is in an offline state, it means that the robot is turned off or disconnected from the network, and the robot cannot receive control signals from the server or host computer.
[0215] After receiving the trapped signal of the first robot, the server first obtains a device list of robots currently in an online state to obtain M online robots.
[0216] Then the server further determines the distance value between each of the M online robots and the trapped first robot. According to the M distance values between the M online robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a second threshold are selected.
[0217] The embodiment of the present invention selects the robots whose distance values from the trapped location of the first robot are less than a second threshold among the online standby robots as candidate robots, so as to select as many candidate robots as possible and improve the success rate of the robots' escape.
[0218] Based on any of the above embodiments, determining a second robot from at least one candidate robot according to the distance value includes:
[0219] The candidate robot with the smallest distance value is determined as the second robot.
[0220] In an embodiment of the present invention, the candidate robot that is closest to the trapped first robot among the determined candidate robots is determined as the second robot, thereby ensuring that the second robot can go to the trapped location of the first robot as soon as possible, thereby improving the efficiency of the robot's escape.
[0221] In some embodiments of the present invention, a control method for a mobile robot is provided, which is applied to the robot. Figure 5 FIG. 2 shows a second flow chart of a control method for a mobile robot according to an embodiment of the present invention. Figure 5 As shown, the control method includes:
[0222] Step 402, when receiving an escape signal from the server, determining the position information of the trapped robot according to the escape signal;
[0223] Step 404, obtaining the stuck information corresponding to the trapped robot according to the position information;
[0224] Step 406, performing auxiliary escape operations according to the stuck information.
[0225] In the embodiment of the present invention, when the robot is performing a work task, if the robot is blocked by an obstacle and cannot escape by itself, the robot will send a trapped signal to the server. After receiving the trapped signal, the server determines the trapped area of the trapped robot according to the location information carried in the trapped signal.
[0226] The server may be a cloud server, a robot base station, or a smart gateway that establishes a wireless network connection with the robot.
[0227] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0228] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0229] On the basis of any of the above embodiments, obtaining the stuck information corresponding to the trapped robot according to the position information includes:
[0230] Move to at least one target position, the at least one target position is related to the position included in the position information; determine the stuck information based on the image data or sensor data of the at least one target position
[0231] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, where the target position is related to the position information in the trapped signal, specifically near the trapped position of the first robot.
[0232] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0233] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0234] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0235] Exemplarily, the second robot moves around the first robot, and at the same time collects stuck information around the first robot through its own camera or sensors such as laser radar.
[0236] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0237] Based on any of the above embodiments, the jam information includes obstacle information, a jam location and / or a jam direction of the first robot; and performing an auxiliary escape operation according to the jam information includes:
[0238] A jam map of the first robot is generated according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0239] In the embodiment of the present invention, the obstacle information specifically refers to obstacles that cause the robot to be stuck, such as corners, debris on the ground, furniture, etc.
[0240] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0241] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0242] The second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot, wherein the auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0243] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0244] Based on any of the above embodiments, the control method further includes:
[0245] When the robot is detected to be in a trapped state, a trapped signal is sent to the server; when a trapped map is received from the server or other robots, an escape route is determined according to the trapped map; and an escape movement is performed according to the escape route.
[0246] In the embodiment of the present invention, when the robot is performing a work task, if the robot is blocked by an obstacle, the robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the robot fails to cross the obstacle or bypass the obstacle for many times, the robot determines that it has entered a trapped state, and at this time the robot sends a trapped signal to the server.
[0247] After receiving the trapped signal, the server will find other robots that can help the current robot escape based on the location information carried in the trapped signal. The robot that receives the escape signal will go to the area where the trapped robot is located based on the location information, and collect the trapped information near the trapped robot, and generate a corresponding trapped map through its own mapping capabilities.
[0248] The robot assisting in escaping can send the generated stuck map to the server, and the server sends the stuck map to the trapped robot. The robot assisting in escaping can also directly send the stuck map directly to the trapped robot through the wireless network connection between the robot and the trapped robot.
[0249] Since the trapped map records the information of objects within a certain range near the trapped robot, it also includes information such as the location, shape, and height of obstacles. Therefore, the trapped robot can understand the location, shape, and height of surrounding obstacles based on the received trapped map, thereby planning an escape route in a targeted manner and performing escape movements according to the escape route.
[0250] An embodiment of the present invention provides a collaborative escape method between multiple robots, in which non-trapped robots collect stuck information near a trapped robot and generate a stuck map. The trapped robot plans an escape route in a targeted manner based on the stuck map, thereby effectively escaping from the trapped state based on the escape route, thereby improving the success rate of the robot's escape.
[0251] In some embodiments of the present invention, a control device for a mobile robot is provided, which is applied to a server. Figure 6 FIG. 1 shows one of the structural block diagrams of the control device of the mobile robot according to an embodiment of the present invention. Figure 6 As shown, the control device 500 of the mobile robot includes:
[0252] An acquisition module 502 is used to acquire a trapped signal of the first robot;
[0253] The control module 504 is used to control the second robot to obtain the jamming information of the first robot based on the jamming signal; and control the second robot to perform an auxiliary escape operation based on the jamming information to assist the first robot in escaping.
[0254] In an embodiment of the present invention, the first robot is a robot that is performing a work task, such as a sweeping robot that is performing an indoor cleaning task.
[0255] When the first robot is blocked by an obstacle, the first robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the first robot fails to cross the obstacle or bypass the obstacle for many times, the first robot determines that it has entered a trapped state, and at this time, the first robot sends a trapped signal to the server.
[0256] Exemplarily, the trapped signal carries information such as the trapped state, location information, and identification information of the first robot.
[0257] The server can be a cloud server, a robot base station, or a device such as an intelligent gateway that establishes a wireless network connection with the robot.
[0258] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0259] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0260] Based on any of the above embodiments, the determination module is further used to determine the position information of the first robot according to the trapped signal; determine the second robot;
[0261] The control device also includes a sending module, which is used to send an escape signal to the second robot, and the escape signal includes position information;
[0262] The control module is further used to control the second robot to move to the position included in the position information.
[0263] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, where the target position is related to the position information in the trapped signal, specifically near the trapped position of the first robot.
[0264] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0265] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0266] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0267] Exemplarily, the second robot moves around the first robot and collects stuck information around the first robot through its own camera or laser radar or other sensors. Figure 2 FIG. 4 is a schematic diagram showing a robot acquiring stuck information according to an embodiment of the present invention. Figure 2 As shown, the first robot 202 is trapped, and the second robot 204 moves to the vicinity of the first robot 202 and moves around the first robot 202 to collect the trapped information around the first robot 202.
[0268] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0269] Based on any of the above embodiments, the stuck information includes obstacle information, the stuck location and / or stuck direction of the first robot.
[0270] In the embodiment of the present invention, the obstacle information specifically refers to obstacles that cause the robot to be stuck, such as corners, debris on the ground, furniture, etc.
[0271] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0272] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0273] According to the stuck information, it is possible to reversely infer the escape route in the time domain that helps the first robot escape, thereby improving the success rate of escaping.
[0274] Based on any of the above embodiments, the control module is specifically used to:
[0275] According to the obstacle information, the stuck position and / or stuck direction of the first robot, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping. The auxiliary escape operation is determined based on the obstacle information, the stuck position and / or stuck direction of the first robot.
[0276] In an embodiment of the present invention, the second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot, wherein the auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0277] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0278] Sending the escape route to the first robot can effectively help the first robot escape.
[0279] Based on any of the above embodiments, the control module is specifically used to:
[0280] The second robot is controlled to generate a jam map of the first robot according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0281] In an embodiment of the present invention, the second robot relies on its own mapping capability to construct a jam map near the first robot based on jam information near the first robot, including obstacle information, the jam location and / or jam direction of the first robot.
[0282] The stuck map can help the first robot understand the location, shape, height and other information of the surrounding obstacles, so as to plan an escape route in a targeted manner. The trapped first robot can carry out escape movements in a targeted manner according to the planned escape route, which can effectively improve the escape efficiency.
[0283] Exemplarily, the stuck map may be grid map information including obstacle information.
[0284] For example, Figure 3 FIG. 4 shows a schematic diagram of a card trap map according to an embodiment of the present invention. Figure 3 As shown, the stuck map 300 may be grid map information including obstacle information. The stuck map 300 specifically includes the position information of the first robot 302 and the obstacle 304 , and the first robot 302 plans an escape route according to the stuck map 300 .
[0285] Based on any of the above embodiments, the first determining module is specifically configured to:
[0286] Determine at least one candidate robot; determine a distance value between each candidate robot in the at least one candidate robot and the first robot; and determine a second robot in the at least one candidate robot according to the distance value.
[0287] In the embodiment of the present invention, the server determines an alternative robot according to the trapped location information of the first robot, and the alternative robot is a robot in the same area as the trapped location of the first robot, such as a robot in the living room.
[0288] After determining at least one candidate robot in the same area, the server further determines the distance value between each candidate robot and the first robot according to the position information of the candidate robots and the trapped position of the first robot.
[0289] The server selects an alternative robot that is closer to the first robot as the second robot based on the distance between the alternative robot and the first robot, and sends an escape signal to the second robot. After receiving the escape signal, the second robot moves to the trapped location of the first robot and helps the first robot escape.
[0290] The embodiment of the present invention selects a robot for helping a trapped robot to escape according to the distance information between the trapped robot and the trapped position, thereby improving the efficiency of escaping the robot.
[0291] Based on any of the above embodiments, the first determining module is further configured to:
[0292] N standby robots in a standby state are determined, where N is a positive integer; and among the N standby robots, at least one candidate robot whose distance value to the first robot is less than a first threshold is determined.
[0293] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server first obtains N standby robots that are currently in standby state and can be called by the server. The standby state specifically means that the robot has no task or work being performed and can be called by the server.
[0294] After determining the N standby robots that can be called, the server further determines the distance value between each of the N standby robots and the trapped first robot. According to the N distance values between the N standby robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a first threshold are selected.
[0295] The embodiment of the present invention uses a robot in a standby state whose distance to the trapped location of the first robot is less than a first threshold as a backup robot, which can avoid interrupting the work progress of the robot in a working state and improve the success rate of the robot's escape while ensuring that the robot's work task is not affected.
[0296] Based on any of the above embodiments, the first determining module is further configured to:
[0297] M online robots in an online state are determined, where M is a positive integer; and among the M online robots, at least one candidate robot whose distance value to the first robot is less than a second threshold is determined.
[0298] In the embodiment of the present invention, the robot in the online state is a robot that can be called by the server. Specifically, when the robot is in the online state, the robot can exchange data with the host computer or server through the gateway, and the server can call the online robot to perform the corresponding task by sending a control signal.
[0299] On the other hand, if the robot is in an offline state, it means that the robot is turned off or disconnected from the network, and the robot cannot receive control signals from the server or host computer.
[0300] After receiving the trapped signal of the first robot, the server first obtains a device list of robots currently in an online state to obtain M online robots.
[0301] Then the server further determines the distance value between each of the M online robots and the trapped first robot. According to the M distance values between the M online robots and the first robot, one or more candidate robots whose distance values from the first robot are less than a second threshold are selected.
[0302] The embodiment of the present invention selects the robots whose distance values from the trapped location of the first robot are less than a second threshold among the online standby robots as candidate robots, so as to select as many candidate robots as possible and improve the success rate of the robots' escape.
[0303] Based on any of the above embodiments, the first determination module is further configured to determine the candidate robot with the smallest distance value as the second robot.
[0304] In an embodiment of the present invention, the candidate robot that is closest to the trapped first robot among the determined candidate robots is determined as the second robot, thereby ensuring that the second robot can go to the trapped location of the first robot as soon as possible, thereby improving the efficiency of the robot's escape.
[0305] In some embodiments of the present invention, a control device for a mobile robot is provided, which is applied to the robot. Figure 7 FIG. 2 shows a second structural block diagram of a control device for a mobile robot according to an embodiment of the present invention. Figure 7 As shown, the control device 600 of the mobile robot includes:
[0306] A determination module 602 is used to determine the position information of the trapped robot according to the escape signal when receiving the escape signal from the server;
[0307] An acquisition module 604 is used to acquire the jamming information corresponding to the trapped robot according to the position information;
[0308] The execution module 606 is used to execute the auxiliary escape operation according to the stuck information.
[0309] In the embodiment of the present invention, when the robot is performing a work task, if the robot is blocked by an obstacle and cannot escape by itself, the robot will send a trapped signal to the server. After receiving the trapped signal, the server determines the trapped area of the trapped robot according to the location information carried in the trapped signal.
[0310] The server may be a cloud server, a robot base station, or a smart gateway that establishes a wireless network connection with the robot.
[0311] After the server receives the trapped signal, the server controls the second robot to obtain the trapped information of the first robot according to the trapped signal, thereby determining the actual trapped situation of the robot, and based on the trapped information, controls the second robot to perform auxiliary escape operations to help the first robot escape from the trapped state based on the trapped information of the first robot, thereby assisting the first robot to escape.
[0312] The embodiment of the present invention provides an assisted escape method based on multiple robots. After a robot is trapped, other robots are controlled to assist the trapped robot in escaping, thereby improving the success rate of the robot's escape.
[0313] Based on any of the above embodiments, the execution module is further used to move to at least one target position, and the at least one target position is related to the position included in the position information;
[0314] The determination module is also used to determine the stuck information based on the image data or sensor data of at least one target position.
[0315] In the embodiment of the present invention, after receiving the trapped signal of the first robot, the server determines a target position according to the trapped signal, where the target position is related to the position information in the trapped signal, specifically near the trapped position of the first robot.
[0316] The server controls the second robot to move to the target position, and obtains image data or sensor data at the target position.
[0317] Specifically, the second robot is provided with an image sensor, such as a camera, through which image data of the target position can be captured. The robot can also be provided with sensors such as a laser radar, an ultrasonic sensor, and an edge sensor, through which sensor data of the target position can be acquired.
[0318] The second robot can accurately determine the actual jamming situation of the first robot based on the image data or sensor data of the target position and obtain the jamming information corresponding to the first robot.
[0319] Exemplarily, the second robot moves around the first robot, and at the same time collects stuck information around the first robot through its own camera or sensors such as laser radar.
[0320] The actual trapped situation of the first robot can be determined according to the stuck information, so the second robot assists the robot to escape according to the stuck information, which can improve the success rate of escaping.
[0321] Based on any of the above embodiments, the stuck information includes obstacle information, a stuck position and / or a stuck direction of the first robot;
[0322] Execution module, specifically used for:
[0323] A jam map of the first robot is generated according to the obstacle information, the jam location and / or the jam direction of the first robot; the jam map is sent to the first robot so that the first robot plans an escape route according to the jam map.
[0324] In the embodiment of the present invention, the obstacle information specifically refers to obstacles that cause the robot to be stuck, such as corners, debris on the ground, furniture, etc.
[0325] The stuck part of the first robot is specifically the part where the first robot contacts the obstacle, such as the skirt, the running wheels, etc.
[0326] The stuck direction specifically refers to the direction of the obstacle relative to the robot, such as the stuck direction is the walking direction of the robot.
[0327] The second robot performs a corresponding auxiliary escape operation according to the stuck information of the first robot, wherein the auxiliary escape operation is determined according to the stuck information of the first robot, specifically according to the obstacle information, the stuck position and / or stuck direction of the first robot.
[0328] For example, the second robot determines the position of the obstacle that caused the first robot to be stuck, the position where the obstacle contacts the first robot, that is, the stuck part of the first robot, and combines the position of the obstacle relative to the first robot, that is, the stuck direction of the first robot, to reversely derive an escape route that can enable the first robot to escape from the current stuck state.
[0329] Based on any of the above embodiments, the sending module is further used to send a trapped signal to the server when detecting that the robot is in a trapped state;
[0330] The determination module is further used to determine an escape route according to the stuck map when receiving the stuck map sent by the server or other robots;
[0331] The motion control module is also used to execute the escape motion according to the escape route.
[0332] In the embodiment of the present invention, when the robot is performing a work task, if the robot is blocked by an obstacle, the robot will first try to cross the obstacle or adjust the direction of travel to bypass the obstacle. After the robot fails to cross the obstacle or bypass the obstacle for many times, the robot determines that it has entered a trapped state, and at this time the robot sends a trapped signal to the server.
[0333] After receiving the trapped signal, the server will find other robots that can help the current robot escape based on the location information carried in the trapped signal. The robot that receives the escape signal will go to the area where the trapped robot is located based on the location information, and collect the trapped information near the trapped robot, and generate a corresponding trapped map through its own mapping capabilities.
[0334] The robot assisting in escaping can send the generated stuck map to the server, and the server sends the stuck map to the trapped robot. The robot assisting in escaping can also directly send the stuck map directly to the trapped robot through the wireless network connection between the robot and the trapped robot.
[0335] Since the trapped map records the information of objects within a certain range near the first robot, it also includes information such as the location, shape, and height of obstacles. Therefore, the trapped robot can understand the location, shape, and height of surrounding obstacles based on the received trapped map, thereby planning an escape route in a targeted manner and performing escape movements according to the escape route.
[0336] An embodiment of the present invention provides a collaborative escape method between multiple robots, in which non-trapped robots collect stuck information near a trapped robot and generate a stuck map. The trapped robot plans an escape route in a targeted manner based on the stuck map, thereby effectively escaping from the trapped state based on the escape route, thereby improving the success rate of the robot's escape.
[0337] In some embodiments of the present invention, a control device for a mobile robot is provided. Figure 8 FIG. 3 shows a third structural block diagram of a control device for a mobile robot according to an embodiment of the present invention. Figure 8As shown, the control device 700 of the mobile robot includes: a memory 702, which is used to store programs or instructions; a processor 704, which is used to implement the steps of the mobile robot control method provided in any of the above embodiments when executing the programs or instructions, and therefore also includes all its beneficial effects, which will not be repeated here to avoid repetition.
[0338] In some embodiments of the present invention, a readable storage medium is provided, on which a program or instruction is stored. When the program or instruction is executed by a processor, the steps of the mobile robot control method provided in any of the above embodiments are implemented, and therefore all its beneficial effects are also included. To avoid repetition, they will not be repeated here.
[0339] In some embodiments of the present invention, a robot is provided, including a control device for a mobile robot as provided in any of the above embodiments; and / or a readable storage medium as provided in any of the above embodiments, and therefore also including all of its beneficial effects, which will not be described here to avoid repetition.
[0340] In the description of the present invention, the term "plurality" refers to two or more than two. Unless otherwise clearly defined, the orientation or positional relationship indicated by the terms "upper" and "lower" is based on the orientation or positional relationship described in the accompanying drawings. It is only for the convenience of describing the present invention and simplifying the description, and does not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation. Therefore, it cannot be understood as a limitation on the present invention. The terms "connection", "installation", "fixation", etc. should be understood in a broad sense. For example, "connection" can be a fixed connection, a detachable connection, or an integral connection; it can be directly connected or indirectly connected through an intermediate medium. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0341] In the description of the present invention, the description of the terms "one embodiment", "some embodiments", "specific embodiments", etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In the present invention, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.
[0342] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.
Claims
1. A control method for a mobile robot, applied to a server, characterized in that: include: Acquire a distress signal of the first robot; Based on the trapped signal, controlling the second robot to obtain the trapped information of the first robot; as well as Based on the stuck information, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping from the stuck state.
2. The control method of the mobile robot according to claim 1, characterized in that: After the step of obtaining the trapped signal of the first robot, the control method further includes: determining the position information of the first robot according to the trapped signal; Identify the second robot; sending an escape signal to the second robot, wherein the escape signal includes the position information; and The second robot is controlled to move to the position included in the position information.
3. The control method of the mobile robot according to claim 2, characterized in that: The controlling the second robot to obtain the stuck information of the first robot includes: controlling the second robot to move to at least one target position, the at least one target position being related to the position included in the position information; Controlling the second robot to obtain image data or sensor data of the at least one target location; The second robot is controlled to determine the jamming information based on the image data or the sensor data.
4. The control method of the mobile robot according to claim 1, characterized in that: The jamming information includes obstacle information, a jamming location and / or a jamming direction of the first robot.
5. The control method of the mobile robot according to claim 4, characterized in that: Based on the stuck information, controlling the second robot to perform an assisting escape operation to assist the first robot in escaping includes: According to the obstacle information, the stuck position and / or stuck direction of the first robot, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping, and the auxiliary escape operation is determined based on the obstacle information, the stuck position and / or stuck direction of the first robot.
6. The control method of the mobile robot according to claim 5, characterized in that: The controlling the second robot to perform the auxiliary escape operation according to the obstacle information, the stuck position and / or the stuck direction of the first robot comprises: Controlling the second robot to generate a stuck map of the first robot according to the obstacle information and the stuck position and / or stuck direction of the first robot; The stuck map is sent to the first robot so that the first robot can plan an escape route according to the stuck map.
7. The control method of the mobile robot according to claim 4, characterized in that: The step of controlling the second robot to perform an assisting escape operation based on the stuck information to assist the first robot in escaping from the stuck state comprises: sending a first escape signal to the second robot, wherein the first escape signal includes position information; controlling the second robot to move to a position included in the position information; and The second robot is controlled to perform the auxiliary escape operation.
8. The control method of the mobile robot according to claim 7, characterized in that: The step of controlling the second robot to perform the auxiliary escape operation includes: The second robot is controlled to apply a thrust to the first robot along a first direction.
9. The control method of the mobile robot according to claim 2, characterized in that: The determining of the second robot comprises: determining at least one candidate robot; Determine a distance value between each candidate robot of the at least one candidate robot and the first robot; The second robot is determined from among the at least one candidate robot according to the distance value.
10. The control method of the mobile robot according to claim 9, characterized in that: The determining of at least one candidate robot comprises: Determine N standby robots in a standby state, where N is a positive integer; Among the N standby robots, at least one candidate robot whose distance value to the first robot is smaller than a first threshold is determined.
11. The control method of the mobile robot according to claim 9, characterized in that: The determining of at least one candidate robot comprises: Determine M online robots that are online, where M is a positive integer; Among the M online robots, at least one candidate robot whose distance value to the first robot is smaller than a second threshold is determined.
12. The control method of a mobile robot according to any one of claims 9 to 11, characterized in that: Determining the second robot from the at least one candidate robot according to the distance value comprises: The candidate robot with the smallest distance value is determined as the second robot.
13. A control method for a mobile robot, applied to the robot, characterized in that: include: When receiving an escape signal from the server, determining the position information of the trapped robot according to the escape signal; According to the position information, obtaining the stuck information corresponding to the stuck robot; An auxiliary escape operation is performed according to the stuck information.
14. The control method of the mobile robot according to claim 13, characterized in that: The obtaining, according to the position information, the jamming information corresponding to the trapped robot comprises: moving to at least one target location, the at least one target location being related to a location included in the location information; The stuck information is determined based on the image data or sensor data of the at least one target position.
15. The control method of the mobile robot according to claim 14, characterized in that: The stuck information includes obstacle information, a stuck position and / or a stuck direction of the first robot; The performing of the auxiliary escape operation according to the stuck information includes: Generate a stuck map of the first robot according to the obstacle information, the stuck location and / or stuck direction of the first robot; The stuck map is sent to the first robot so that the first robot can plan an escape route according to the stuck map.
16. The control method of a mobile robot according to any one of claims 13 to 15, characterized in that: Also includes: When detecting that the robot is in a trapped state, sending a trapped signal to the server; Upon receiving a stuck map sent by the server or another robot, determining an escape route according to the stuck map; The escape movement is performed according to the escape route.
17. A control device for a mobile robot, applied to a server, characterized in that: include: An acquisition module, used for acquiring a trapped signal of the first robot; A control module, configured to control the second robot to obtain the stuck information of the first robot based on the stuck signal; as well as Based on the stuck information, the second robot is controlled to perform an auxiliary escape operation to assist the first robot in escaping from the stuck state.
18. A control device for a mobile robot, applied to the robot, characterized in that: include: A determination module, configured to determine the position information of the trapped robot according to the escape signal when receiving the escape signal from the server; An acquisition module, used for acquiring the stuck information corresponding to the trapped robot according to the position information; An execution module is used to execute an auxiliary escape operation according to the stuck information.
19. A control device for a mobile robot, characterized in that: include: Memory, used to store programs or instructions; A processor, configured to implement the steps of the mobile robot control method as described in any one of claims 1 to 16 when executing the program or instruction.
20. A readable storage medium having a program or instruction stored thereon, characterized in that: When the program or instruction is executed by a processor, the steps of the method for controlling a mobile robot according to any one of claims 1 to 16 are implemented.
21. A robot, characterized in that: include: A control device for a mobile robot as claimed in any one of claims 17 to 19; and / or The readable storage medium of claim 20.
