WO2023124788A1 - Autonomous mobile device, control method therefor, apparatus, and storage medium - Google Patents

Autonomous mobile device, control method therefor, apparatus, and storage medium Download PDF

Info

Publication number
WO2023124788A1
WO2023124788A1 PCT/CN2022/136455 CN2022136455W WO2023124788A1 WO 2023124788 A1 WO2023124788 A1 WO 2023124788A1 CN 2022136455 W CN2022136455 W CN 2022136455W WO 2023124788 A1 WO2023124788 A1 WO 2023124788A1
Authority
WO
WIPO (PCT)
Prior art keywords
obstacle
mobile device
autonomous mobile
area
stuck
Prior art date
Application number
PCT/CN2022/136455
Other languages
French (fr)
Chinese (zh)
Inventor
许思晨
Original Assignee
速感科技(北京)有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 速感科技(北京)有限公司 filed Critical 速感科技(北京)有限公司
Publication of WO2023124788A1 publication Critical patent/WO2023124788A1/en

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle

Definitions

  • the present disclosure relates to the technical field of smart home, and in particular to an autonomous mobile device, a control method and device thereof, and a storage medium.
  • Autonomous mobile devices refer to smart devices that autonomously perform preset tasks within a set working area.
  • autonomous mobile devices usually include but are not limited to cleaning robots (such as smart sweepers, smart floor mopping machines, window cleaning robots), accompanying mobile Robots (such as smart electronic pets, nanny robots), service mobile robots (such as hotels, hotels, reception robots in meeting places), industrial inspection smart devices (such as power inspection robots, smart forklifts, etc.), security robots (such as household Or commercial intelligent guard robot), etc.
  • the motion unit (also known as the driving mechanism) of the autonomous mobile device is usually a part such as a wheel or a track that drives the autonomous mobile device to move on a plane through rotation, which causes the autonomous mobile device to be blocked by some specific obstacles (such as thresholds, glass, etc.)
  • Some specific obstacles such as thresholds, glass, etc.
  • the slide rail of the door, or the edge part of the floor mat with a certain height laid indoors blocks and cannot cross this type of obstacle, or even be stuck by this type of obstacle, causing it to be unable to escape from the predicament caused by this obstacle.
  • obstacles such as thresholds are called surmountable obstacles.
  • autonomous mobile devices usually use various sensors on autonomous mobile devices to detect surmountable obstacles.
  • the front camera or ranging sensor (such as lidar) of the autonomous mobile device is usually used to identify a specific surmountable obstacle on the ground in front of it, and after judging that the obstacle in front of it is a surmountable obstacle , make corresponding actions to perform obstacle-surmounting processing (obstacle-surmounting processing in this disclosure refers to processing for surmounting surmountable obstacles).
  • the front camera recognizes that the obstacle is a surmountable obstacle such as a threshold or a floor mat with a certain height and/or using a ranging sensor (such as a lidar placed on the front of the autonomous mobile device and emitting Geometric calculation detects the height of an obstacle at a certain distance in front of the autonomous mobile device) If the height of the detected obstacle is lower than a certain height threshold such as 2.7cm, the obstacle is a surmountable obstacle, and the autonomous mobile device can make corresponding Action to perform obstacle handling.
  • a surmountable obstacle such as a threshold or a floor mat with a certain height and/or using a ranging sensor (such as a lidar placed on the front of the autonomous mobile device and emitting Geometric calculation detects the height of an obstacle at a certain distance in front of the autonomous mobile device) If the height of the detected obstacle is lower than a certain height threshold such as 2.7cm, the obstacle is a surmountable obstacle, and the autonomous mobile device can make corresponding Action to perform obstacle handling.
  • the above-mentioned methods of assisting autonomous mobile devices to overcome surmountable obstacles through cameras or ranging sensors all have certain limitations.
  • the front camera of the first method may recognize the threshold or the edge of the floor mat, it is limited by the computing power of the processor and the inherent problem of the sensor that it is difficult to identify the height of the object through the photo, which will lead to the detection of obstacles that can be crossed.
  • the recognition success rate is limited, which often leads to false detections; for the second method, due to the limitation of the computing power of the processor and the influence of external ambient light and ground material color, etc., it will also lead to the detection accuracy of lidar for surmountable obstacles. lower.
  • the autonomous mobile device may make incorrect handling in certain environments, such as the autonomous mobile device may recognize the sliding rail of the glass door leading to the balcony or the kitchen as an impassable common obstacle instead of the balcony or kitchen cleaning, resulting in a poor user experience, or an increased number of autonomous mobile devices getting stuck due to straying into troubled areas.
  • the present disclosure proposes an autonomous mobile device, a control method and device thereof, and a storage medium.
  • a control method of an autonomous mobile device comprising: an acquisition step, used to acquire a map marked with an obstacle surmountable area; a judging step, used to judge the autonomous movement Whether the device is stuck in the obstacle surmountable area; a processing step for ordering the autonomous mobile device to execute an obstacle surmounting mode when it is determined that the autonomous mobile device is stuck in the obstacle surmountable area , to try to pass through the obstacle-traversable area.
  • a control device for an autonomous mobile device includes: an acquisition unit for acquiring a map marked with an obstacle-surpassable area; a judging unit for judging the autonomous movement Whether the device is stuck in the obstacle surmountable area; a processing unit, configured to order the autonomous mobile device to execute an obstacle surmounting mode if it is determined that the autonomous mobile device is stuck in the obstacle surmountable area , to try to pass through the obstacle-traversable area.
  • a control device for an autonomous mobile device comprising: a processor; a memory for storing instructions executable by the processor; wherein the processor is configured to execute the above-mentioned Control Method.
  • an autonomous mobile device comprising: the control device described above; and a motion unit, configured to respond to the control device instructing the autonomous mobile device to perform an obstacle surmounting mode, moving in the obstacle clearance mode in an attempt to pass through the obstacle clearance area.
  • a non-transitory computer-readable storage medium When the instructions in the storage medium are executed by a processor, the processor can execute the above control method.
  • the present disclosure obtaining a map marked with an obstacle traversable area (where a surmountable obstacle is located), and instructing the autonomous mobile device to execute an obstacle traversal mode in case the autonomous mobile device becomes stuck in the obstacle traversable area, to try to pass through the obstacle-passable area.
  • the present disclosure assists in overcoming obstacles by means of a map marked with obstacle-surpassable areas, In this way, the problems described above caused by the inability to accurately distinguish between surmountable obstacles and dangerous distressed areas can be avoided.
  • the autonomous mobile device can first try to cross the obstacle-surpassable area in the obstacle-surpassing mode, so that Reach more locations and achieve more functions.
  • Figures 1a-1c show a flowchart of a method of controlling an autonomous mobile device according to an exemplary embodiment.
  • Fig. 1d shows a flow diagram of building a map by an autonomous mobile device according to an exemplary embodiment.
  • Fig. 2a shows a schematic diagram of a map marked with obstacle traversable areas according to an exemplary embodiment.
  • Figures 2b-2e show schematic diagrams of a threshold as a surmountable obstacle according to an exemplary embodiment.
  • Fig. 3a shows a schematic diagram of a cost distribution of a grid map of obstacle areas according to an exemplary embodiment.
  • Fig. 3b shows a schematic diagram of a cost distribution of a grid map of non-obstacle areas according to an exemplary embodiment.
  • Fig. 3c shows a schematic diagram of a planned path according to an exemplary embodiment without adjusting the search method for points located in the obstacle-surpassable area.
  • Fig. 3d shows a schematic diagram of a planned path according to an exemplary embodiment after adjusting the search method for points located in the obstacle-surpassable area.
  • Fig. 3e shows a schematic diagram of the angle between an autonomous mobile device and an obstacle according to an exemplary embodiment.
  • 4-7a illustrate a flow diagram of an autonomous mobile device operating in an obstacle clearance mode, according to an exemplary embodiment.
  • Figures 7b-7e illustrate schematic diagrams of an autonomous mobile device operating in the obstacle clearance mode shown in Figure 7a to attempt to cross a threshold, according to an exemplary embodiment.
  • Figures 8a-8b show schematic diagrams of an autonomous mobile device operating in an obstacle clearance mode according to an exemplary embodiment.
  • Fig. 9 shows a block diagram of a control device of an autonomous mobile device according to an exemplary embodiment.
  • Figure 10 shows a block diagram of an autonomous mobile device, according to an exemplary embodiment.
  • the autonomous mobile device may not be able to accurately detect the surmountable obstacle, so that the autonomous mobile device does not try to pass through the surmountable obstacle and thus does not travel to the area it could have traveled to, or makes the The autonomous mobile device misidentifies the surmountable obstacle, which leads to multiple collisions with common obstacles, resulting in damage to the autonomous mobile device itself or damage to common obstacles (such as furniture). Therefore, it is difficult to accurately judge surmountable obstacles such as door sills, slide rails of glass doors, edges of floor mats, etc. simply by using a camera or a distance measuring sensor.
  • the autonomous mobile device considering that if the autonomous mobile device can know where the obstacle is a surmountable obstacle that can be crossed, then the autonomous mobile device only needs to ensure that it can make The correct obstacle-crossing process can pass through the obstacle-crossable area without worrying about the various problems described above.
  • the real-time positioning of autonomous mobile devices in the home environment has become easier and easier.
  • the map of the home environment, and the user marks the obstacle-surpassable area corresponding to the surmountable obstacle on the map through the APP and sends it to the autonomous mobile device, then the autonomous mobile device can accurately determine the obstacle-surpassable area, so that The autonomous mobile device can operate in the obstacle-crossing area according to the preset obstacle-crossing mode, so as to easily cross the obstacle-crossing area where the crossable obstacle is located.
  • the autonomous mobile device can detect in real time whether it has crossed a surmountable obstacle in normal operation mode (for example, by detecting whether it is stuck in the surmountable area to detect whether it has crossed a surmountable obstacle), when When it detects that it has not crossed a surmountable obstacle, the autonomous mobile device operates in a specific obstacle-crossing mode that is more likely to cross the traversable obstacle, so as to increase the probability of the autonomous mobile device crossing the surmountable obstacle .
  • Such autonomous mobile devices may include, but are not limited to, cleaning robots (such as smart sweepers, smart mopping machines, window cleaning robots), companion mobile robots (such as smart electronic pets, nanny robots), service mobile robots (such as hotels, Reception robots in hotels and meeting places), industrial inspection intelligent equipment (such as power inspection robots, intelligent forklifts, etc.), security robots (such as household or commercial intelligent security robots) and other intelligent devices that can move autonomously.
  • the execution subject of the control method in this embodiment may include, but not limited to, a control unit of the autonomous mobile device, an external device of the autonomous mobile device, and the like, for example.
  • control method of this exemplary embodiment may include the following steps:
  • step S110 a map marked with obstacle-surpassing areas is obtained.
  • the obstacle surmountable area may represent a corresponding area in the map of the surmountable obstacle.
  • the autonomous mobile device may directly acquire a pre-stored map marked with obstacle-surpassable areas from its own storage unit (such as an internal storage device or device).
  • its own storage unit such as an internal storage device or device.
  • the autonomous mobile device once performed a work task on a certain workspace (for example, a cleaning robot performed a cleaning task), and during the execution of the work task, the autonomous mobile device established and stored an initial map of the workspace (such as storing the initial map of the workspace in its own storage unit), marking in the initial map the obstacle-surpassable area corresponding to the area occupied by the surmountable obstacle (can be marked manually or automatically by the processing unit), Become a map marked with obstacle-crossable areas and store it, so that when performing follow-up work tasks on the same workspace according to the control method of this embodiment, the autonomous mobile device can directly obtain the marked area from its own storage unit.
  • a map of the obstacle-traversable area may acquire the map from a storage unit of the autonomous mobile device storing the map or a server storing the map through a network.
  • the autonomous mobile device when the autonomous mobile device builds a map in the workspace, it can automatically mark the obstacle-surpassable area on the newly created map.
  • the map can be established by executing the steps in Figure 1d, as shown in Figure 1d, the method for establishing the map includes:
  • step S010 the autonomous mobile device is commanded to operate in an unmapped workspace and map the workspace.
  • step S020 it is determined whether the autonomous mobile device is stuck during the operation of the autonomous mobile device. If it is determined that the autonomous mobile device is stuck, the determination in step S020 is "Yes", and then step S030 is executed. If it is determined that the autonomous mobile device is not stuck, proceed to step S020.
  • step S030 the autonomous mobile device is commanded to execute the obstacle surmounting mode. Then, step S040 is executed.
  • the obstacle clearance mode will be described later.
  • step S040 it is judged whether the autonomous mobile device has passed the area corresponding to the stuck position. If it is determined that the area corresponding to the position where the autonomous mobile device is stuck has passed, the determination in step S040 is "Yes", and then step S050 is executed. If it is determined that the area corresponding to the position where the autonomous mobile device is stuck has not been passed, the determination in step S040 is "No", and then step S060 is executed.
  • step S050 mark the passed area (ie, the area corresponding to the stuck position passed by the autonomous mobile device) on the map as an obstacle-surpassable area.
  • step S060 mark the failed area (that is, the area corresponding to the stuck position where the autonomous mobile device failed to pass) as an impassable area on the map.
  • autonomous mobile devices can automatically identify surmountable obstacles and display them on the map during the map building phase.
  • the obstacle-crossable area is marked on the top, and at the same time, the problem of inaccurate recognition caused by long-distance detection of surmountable obstacles only through the camera and/or distance measuring sensor is avoided.
  • the autonomous mobile device may also use relevant and appropriate methods in the prior art to establish a map of the workspace (such as establishing a map by colliding with obstacles through dead reckoning sensors such as code discs, gyroscopes, and accelerometers, Use the camera or lidar to cooperate with the SLAM of the dead reckoning sensor to build a map, etc.), and then provide the user with the option to mark the obstacle-crossing area on the established map, and the user selects the obstacle-crossing area to guide
  • the autonomous mobile device executes subsequent instructions in the designated (selected) obstacle-surpassable area. Due to limited space, this exemplary embodiment does not elaborate on how the autonomous mobile device builds a map of the workspace and how to mark crossable areas on the map.
  • the autonomous mobile device For ordinary obstacles that the autonomous mobile device can recognize, for example, based on the fact that the autonomous mobile device has not passed through the area corresponding to the location where the autonomous mobile device was stuck before, it is recognized that the obstacle is a common obstacle that can prevent it from passing, or by The direct collision of the collision sensor makes it clear that it is impossible to pass through ordinary obstacles, or the height of the obstacle detected by the proximity sensor is obviously greater than the passable threshold, so that the autonomous mobile device must not be able to cross the common obstacle, and through each sensor Can clearly The common obstacle that the autonomous mobile device cannot cross, the judgment of step S040 is "No", the autonomous mobile device marks it as an impassable area on the map, so that the autonomous mobile device can execute other than the obstacle-crossing mode based on subsequent instructions other modes, such as executing the escape mode (such as back and forth and then rotating, or repeatedly performing rotation and backing away from the obstacle), edge-following mode (such as first rotating so that its side faces the obstacle and continue running, and at the same time
  • the autonomous mobile device can first try to cross the obstacle-surpassable area in the obstacle-surpassing mode, so as to reach as far as possible in the workspace More locations, more functions.
  • step S110 may include: pushing the map of the workspace to the user; and receiving the map in which the user has marked the obstacle-surpassable area.
  • the autonomous mobile device can push the map of the workspace to the user device via the wireless network; the user can intuitively see the passable area from the map and obstacle areas, and can use the user's own judgment to mark the area where the surmountable obstacles in the actual workspace are located as the obstacle-surpassable area on the map; the user device can mark the user as the obstacle-surpassable area
  • the map of the autonomous mobile device is sent to the autonomous mobile device through the wireless network.
  • the autonomous mobile device can receive the map where the user has marked the obstacle-surpassable area.
  • the map pushed by the autonomous mobile device to the user device may be an initial map, or a map that has previously marked the obstacle-surpassable area (either marked by the user or marked by the autonomous mobile device).
  • the user can not only create a new obstacle traversable area on the map, but also modify and/or delete the marked obstacle surmountable area.
  • the user may be prompted to mark the obstacle-crossable area on the map by means such as voice or text message.
  • the user needs to judge whether these obstacles can be crossed by the autonomous mobile device according to his own experience or the standards or parameters provided by the product manual.
  • the user will have a more intuitive judgment on whether the obstacle is a crossable obstacle that can be crossed by the autonomous mobile device, so it is more accurate for the user to mark the obstacle crossable area; in another implementation, the user does not need to judge Whether these obstacles can be crossed by the autonomous mobile device, the user can mark these obstacles and indicate the respective parameters of these obstacles such as height, shape, etc., and the autonomous mobile device can automatically judge whether these obstacles are based on these obstacle parameters. Belongs to surmountable obstacles (such as judging whether these obstacles can be surmounted by autonomous mobile devices).
  • the user equipment can obtain the map marked with the obstacle-surpassable area, and then when the autonomous mobile device executes the control method of this exemplary embodiment, the autonomous mobile device can interact with the The user equipment establishes a communication connection, and sends to the user equipment an acquisition request for a map marked with an obstacle-surpassable area, and the user equipment responds to the acquisition request and sends the map marked with an obstacle-surpassable area to the autonomous mobile device, or the user equipment The user equipment periodically sends the map marked with the obstacle-surpassable area to the autonomous mobile equipment according to a predetermined period.
  • User equipment may include, but is not limited to, devices capable of establishing a communication connection with the autonomous mobile device and having a display, such as mobile terminal devices such as mobile phones and tablet computers, or terminal devices such as servers and desktop computers.
  • the user equipment may also be referred to as the autonomous mobile device.
  • the APP end device may include a display for displaying a map and a sensor (such as a touch screen) for detecting the user's marking action, and when the sensor detects the user's marking action on the first area, the APP end device This first area may be marked on the displayed map as an obstacle clearable area.
  • the map shown in Fig. 2a marked with the obstacle-surpassable area is taken as an example for description below.
  • a map 320 marked with an obstacle-surpassable area is displayed on the display 310 of the user equipment, and an obstacle-surpassable area 340 is marked on the map 320.
  • type obstacle 330, the surmountable obstacle 330 is an obstacle that can be passed by an autonomous mobile device, such as a threshold.
  • the user is recommended a predetermined shape used to mark the surmountable obstacle in the obstacle-surpassable area.
  • the predetermined shape may represent the corresponding surmountable obstacle, for example The cross-sectional shape of a leaping obstacle, whereby the user can mark the obstacle-surpassable area via the predetermined shape, and accordingly, the autonomous mobile device can receive the map in which the user marks the obstacle-surpassable area with the predetermined shape.
  • the aforementioned predetermined shapes include, but are not limited to, rectangles, squares, triangles, circles, ovals, rhombuses, circular arcs, and the like. It should be understood that the present disclosure does not specifically limit the specific shape of the predetermined shape, as long as the predetermined shape can mark the obstacle-surpassable area on the initial map, it should all be applicable to the present disclosure.
  • a threshold located between two rooms due to the need to match with the bottom of the door, there are usually slopes (the cross section of which is shown in Figure 2b) and protrusions (such as the doorway stone, whose cross section is shown in Figure 2c) and/or grooves (such as the slide rail of a glass door, whose cross-section is shown in Figure 2d and Figure 2e), when the forward direction of travel of the autonomous mobile device meets the threshold, its moving mechanism may be due to the slope of the threshold. , vertical surfaces or grooves meet and get stuck, resulting in the autonomous mobile device not being able to smoothly (successfully) cross the threshold.
  • slopes the cross section of which is shown in Figure 2b
  • protrusions such as the doorway stone, whose cross section is shown in Figure 2c
  • grooves such as the slide rail of a glass door, whose cross-section is shown in Figure 2d and Figure 2e
  • step S120 After obtaining the map marked with the obstacle-surpassable area, the following step S120 is performed.
  • step S120 it is determined whether the autonomous mobile device is stuck in the obstacle-surpassable area.
  • Situations where the autonomous mobile device gets stuck include but are not limited to: when the autonomous mobile device passes through relatively low obstacles (such as high thresholds or light sockets), its chassis is lifted by such obstacles and the wheels are suspended in the air , so that the autonomous mobile device cannot continue to operate through the operation of its motion unit; or its wheels are stuck in the slide rails in the threshold (such as the slide rails of glass doors) and cannot operate, so that the autonomous mobile device cannot continue to move forward; or other Wheels getting stuck in some sort of gap just big enough to accommodate the wheels so the wheels can't turn and the autonomous mobile device can't continue to function, and other similar situations.
  • relatively low obstacles such as high thresholds or light sockets
  • its chassis is lifted by such obstacles and the wheels are suspended in the air , so that the autonomous mobile device cannot continue to operate through the operation of its motion unit
  • the wheels are stuck in the slide rails in the threshold (such as the slide rails of glass doors) and cannot operate, so that the autonomous mobile device cannot continue to move forward
  • the usual way to detect that the autonomous mobile device is stuck is to combine the information of multiple sensors to make a comprehensive judgment. For example, it is possible to judge whether the wheel set of the autonomous mobile device is running through the code disc on the wheel set, and at the same time obtain the information of the autonomous mobile device from the ranging sensor. The distance between the autonomous mobile device and the surrounding fixed obstacles or according to the camera to obtain the surrounding environment photos, if the wheel set is running, but the distance between the autonomous mobile device and the surrounding fixed obstacles obtained by the ranging sensor does not change, or through the camera If the change of the objects in multiple photos and the change of the mutual relationship between objects is smaller than that of the objects in multiple photos and the change of the mutual relationship between the objects when the autonomous mobile device is running normally, it can indicate that the autonomous mobile device is stuck .
  • the method for detecting that the autonomous mobile device is stuck is not limited to the above methods.
  • step S120 may include steps S121 and S122.
  • step S121 it is judged whether the autonomous mobile device travels to the obstacle-surpassable area. If it is determined that the autonomous mobile device has run to the obstacle-surpassable area, then execute step S122, otherwise, continue to execute step S121.
  • step S122 continue to judge whether the autonomous mobile device is stuck in the obstacle-crossable area. If it is determined that the autonomous mobile device is stuck in the obstacle-surpassable area, then in step S120 it is determined that the autonomous mobile device is stuck in the obstacle-surpassable area, and then the following step S130 is performed; otherwise, the autonomous mobile device operates in the original operating mode Continue to run, and continue to execute step S121 to determine whether the autonomous mobile device runs out of the current obstacle-crossable area or travels to other obstacle-crossable areas.
  • the autonomous mobile device when running to the obstacle-crossable area marked on the map, it is detected whether the autonomous mobile device is stuck.
  • the autonomous mobile device can judge whether the autonomous mobile device is running to the point where the obstacle can be crossed according to whether its own current position has crossed the boundary position of the obstacle surmountable area or whether the current position of the autonomous mobile device is within the range covered by the obstacle surmountable area. If it is determined that the autonomous mobile device has moved to the obstacle-crossable area, step S121 is judged as "Yes”, and then step S122 is executed to further determine whether the autonomous mobile device is in the obstacle-crossable area. stuck. If it is determined that the autonomous mobile device is stuck in the obstacle-crossable area, then step S122 is judged as "yes”, so step S120 is judged as "yes”, so the following step S130 is executed.
  • step S120 may include steps S123 and S124.
  • step S123 it is determined whether the autonomous mobile device is stuck. If it is determined that the autonomous mobile device is stuck, execute step S124, otherwise, continue to execute step S123. The way to detect that the autonomous mobile device is stuck can be found in the previous section.
  • step S124 continue to judge whether the position where the autonomous mobile device is stuck is within the obstacle-surmountable area. If it is determined that the location where the autonomous mobile device is stuck is within the obstacle-crossable area, it is determined in step S120 that the autonomous mobile device is stuck in the obstacle-crossable area, and then the following step S130 is performed. Otherwise, if it is determined that the location where the autonomous mobile device is stuck is not within the obstacle-surpassable area, then step 170 is performed, and the autonomous mobile device performs a rescue mode and/or an alarm, as shown in Figure 1c; You can mark the stuck location as a normal obstacle or mark the area where the stuck location is located as an impassable area on the map.
  • the autonomous mobile device can detect in real time whether the autonomous mobile device is stuck (that is, execute step S123), if it is determined that the autonomous mobile device is stuck, step S123 judges "Yes", and executes step S124 to further according to the autonomous mobile device Whether the position where the mobile device is stuck is on the boundary of the obstacle surmountable area or within the range of the obstacle surmountable area is used to judge whether the position where the autonomous mobile device is stuck is within the obstacle surmountable area; if it is judged that the autonomous mobile device is If the stuck position is within the obstacle-crossable area, step S124 is judged as "Yes", so step S120 is judged as "Yes”, and the following step S130 is executed.
  • step S120 determines whether the autonomous mobile device is stuck in the obstacle-crossable area. If it is determined in step S120 that the autonomous mobile device is stuck in the obstacle-crossable area, the following step S130 is executed.
  • step S130 the autonomous mobile device is commanded to execute an obstacle surmounting mode, so as to try to pass through the obstacle surmountable area.
  • a map marked with an obstacle-surmountable area is obtained, and in the case that the autonomous mobile device is stuck in the obstacle-surpassable area, the autonomous mobile device is commanded to execute the obstacle-overpass mode in order to try to pass Obstacle traversable area. Therefore, compared with the prior art that directly uses the corresponding sensors of the autonomous mobile device, such as the front camera or the ranging sensor, to assist in overcoming obstacles, the present disclosure assists in overcoming obstacles by means of a map marked with areas that can be surmounted , in this way, the above-described problems caused by the inability to accurately distinguish between surmountable obstacles and dangerous distressed areas can be avoided.
  • steps S140 and S150 may also be performed.
  • step S140 it is judged whether the autonomous mobile device has passed the obstacle-crossable area; if it is judged that the autonomous mobile device has not passed the obstacle-crossable area, step S150 is executed.
  • step S150 re-mark the non-passable obstacle-passable area on the map as an impassable area.
  • the current type of the obstacle-surpassable area can be updated in real time according to whether the autonomous mobile device that has executed the obstacle-surpassing mode passes through the obstacle-surpassable area, and a more accurate map of the obstacle-surpassable area can be provided for the next operation.
  • step S160 may also be performed.
  • the autonomous mobile device tries other paths, such as performing an escape mode (such as back and forth and then rotating, or repeatedly rotating and backing) so as to stay away from the obstacle, or performing an edge-following mode (such as rotating first to make it a
  • an escape mode such as back and forth and then rotating, or repeatedly rotating and backing
  • an edge-following mode such as rotating first to make it a
  • the side faces the obstacle and continues to run, and at the same time, the proximity sensor on the side detects the distance between the side and the obstacle in a non-contact manner and keeps the distance within the set distance range) so that the autonomous mobile device can move along the Run on the edge of the obstacle.
  • the present disclosure does not limit the running path of the autonomous mobile device after not passing through the obstacle-surpassable area.
  • step S130 There are many ways to overcome the obstacles involved in step S130.
  • steps S710, S720, and S730 in FIG. distance S720: the autonomous mobile device brakes the second driving mechanism, and rotates the first driving mechanism forward by a first angle around the second driving mechanism;
  • S730 fixes the first driving mechanism, and makes the The second drive mechanism is rotated forward by a second angle about the first drive mechanism.
  • the first drive mechanism and the second drive mechanism are arranged side by side at the lower part of the autonomous mobile device.
  • the first drive mechanism and the second drive mechanism of the autonomous mobile device will retreat a certain distance together to retreat a certain distance from the stuck position, thereby providing
  • the drive mechanism of the autonomous mobile device rotates to provide room for acceleration before reaching the lower edge of the obstacle slope; then, braking one drive mechanism of the autonomous mobile device, such as the second drive mechanism, makes it stand still or occurs a small amount in the opposite direction Rotate while another drive mechanism, such as the first drive mechanism, rotates an angle around the braked second drive mechanism at a suitable speed or acceleration so as to have a displacement component of forward motion, and then hold the previously rotating first drive mechanism stationary motionless, while the previously braked second drive mechanism orbits the now immobilized first drive mechanism at a suitable speed or acceleration (the speed and/or acceleration of the first drive mechanism and the second drive mechanism may be the same or different)
  • the mechanism is rotated by an angle so as to have a displacement component of forward movement, thereby achieving alternate forward movement of the first drive mechanism and
  • FIG. 7a For ease of understanding, the obstacle surmounting mode in FIG. 7a will be described by taking a surmountable obstacle as the threshold 210 as an example and referring to FIGS. 7b-7e.
  • step S710 is executed, and the autonomous mobile device retreats a first distance driven by the first drive mechanism W1 and the second drive mechanism W2, and the distance between the autonomous mobile device 220 and the threshold 210
  • the schematic diagram of the relative positional relationship between is changed from Fig. 7b to Fig. 7c.
  • step S720 the second drive mechanism W2 is braked, the first drive mechanism W1 rotates around the second drive mechanism W2 by a first angle, and the schematic diagram of the relative positional relationship between the autonomous mobile device 220 and the threshold 210 is shown in FIG. 7c Transformed into Figure 7d.
  • step S730 the first driving mechanism W1 is fixed, and the second driving mechanism W2 is rotated forward by a second angle around the first driving mechanism W1. 7d is transformed into Figure 7e, thereby completing the obstacle surmounting.
  • the two driving mechanisms W1 and W2 are alternately operated through the obstacle-overriding mode of steps S710, S720 and S730, and finally both can cross the slope of the threshold 210 , so as to solve the technical problem that the autonomous mobile device is stuck before the threshold, and it is an effective obstacle-crossing mode in practice.
  • steps S410 and S420 in FIG. The device increases its speed to accelerate to a first preset speed, and attempts to cross the surmountable obstacle at the increased first preset speed (greater than the speed at which the autonomous mobile device is normally operating).
  • This also includes that the autonomous mobile device sets the first preset speed as the target value of the speed increase, but in actual operation, the autonomous mobile device has rushed over a surmountable obstacle or even crossed it before the increased speed reaches the first preset speed The situation in the obstacle-traversable area.
  • steps S510, S520, and S530 in FIG. 5 may be executed in sequence, that is, the autonomous mobile device retreats a first distance from the current position where it is stuck, The autonomous mobile device takes the current direction after the first distance as the initial direction, and rotates the first set angle in situ along the first rotation direction, and then the autonomous mobile device controls its motion unit to move forward while rotating the second rotation direction for the first time. 2. Set the angle, repeat the above process, and try to cross the obstacle-crossing area during the process; if the obstacle-crossing area is successfully crossed, the autonomous mobile device will perform subsequent normal operations.
  • FIG. 8a For an exemplary schematic diagram of the autonomous mobile device operating in the obstacle-surpassing mode, refer to FIG. 8a.
  • the autonomous mobile device takes the current direction after retreating the first distance from the stuck current position A as the initial direction, and first rotates the first setting in place along the first rotation direction (for example, clockwise). Angle ⁇ (such as 85°), and then control its wheel set to move forward while rotating a certain set angle in the second direction of rotation (such as counterclockwise) (which can be called the second set angle, such as 175°)
  • the autonomous mobile device controls its wheel set to move forward and edge A certain rotation direction (such as clockwise) rotates a certain set angle (such as 180°) to reach the coordinate position of point C across the obstacle-surpassable area, and then the subsequent normal operation can be performed.
  • the autonomous mobile device if the autonomous mobile device operates in the obstacle-surpassing mode, steps S610, S620, and S630 in FIG.
  • the autonomous mobile device takes the current direction after retreating the second distance as the initial direction, rotates the third set angle in situ along the third rotation direction, and then the autonomous mobile device controls its motion unit to move forward in a straight line for the set distance, and repeat the above steps repeatedly. Rotate and operate straight until it crosses the obstacle-surpassable area, and then perform subsequent normal operations.
  • FIG. 8b For an exemplary schematic diagram of the autonomous mobile device operating in this obstacle-surpassing mode, please refer to FIG. 8b.
  • the autonomous mobile device takes the current direction after retreating a second distance from the stuck current position A as the initial direction, and first rotates the third setting in place along the third rotation direction (for example, clockwise) Angle ⁇ ' (such as 85°), and then control its wheel set to move forward in a straight line for a set distance to reach the coordinate position of point E1.
  • the third rotation direction for example, clockwise
  • Angle ⁇ ' such as 85°
  • the autonomous mobile device then rotates in a certain direction of rotation (such as counterclockwise) at a set angle (such as 135°), and then controls its wheel set to move forward in a straight line for a certain set distance
  • a certain direction of rotation such as counterclockwise
  • a set angle such as 135°
  • the autonomous mobile device then rotates in a certain direction of rotation (such as clockwise) at a set angle (such as 60°) , and then control its wheel set to move forward in a straight line.
  • the autonomous mobile device successfully crosses the obstacle-surpassing area to point C, and then can perform subsequent normal operations.
  • step S110 parameters of surmountable obstacles in the obstacle-surpassable area are also acquired.
  • the user in addition to marking the obstacle-surpassable area on the map, can also set the parameters of the surmountable obstacles in the obstacle-surpassable area, where the parameters may include but are not limited to the shape of the obstacle (such as cross-sectional shape (e.g. trapezoidal, rectangular, circular, etc.) and/or height.
  • shape of the obstacle such as cross-sectional shape (e.g. trapezoidal, rectangular, circular, etc.) and/or height.
  • the user can set the parameters of the surmountable obstacle through the screen displayed on the user equipment for setting the parameters of the surmountable obstacle, and the screen displays the parameters of the surmountable obstacle.
  • the selection buttons corresponding to various parameters the user can set the corresponding obstacle parameters by clicking the corresponding button. Due to limited space, the present disclosure does not describe the manner in which the user sets the parameters of the surmountable obstacle.
  • Step S130 it may be judged according to the parameters of the surmountable obstacle whether the autonomous mobile device can surmount the surmountable obstacle, wherein, if it is determined that the surmountable obstacle can be surmounted, the above-mentioned Step S130.
  • the autonomous mobile device may judge whether the autonomous mobile device can cross the surmountable obstacle according to the acquired parameters of the surmountable obstacle.
  • the autonomous mobile device may perform step S130 to operate in the obstacle-surpassing mode to try to pass through the obstacle-surmountable area corresponding to the obstacle.
  • the autonomous mobile device can be ordered Perform obstacle avoidance processing such as escape mode and edge following mode to improve work efficiency.
  • the parameter of the surmountable obstacle has a corresponding relationship with the obstacle surmounting mode, and when the autonomous mobile device is stuck in the obstacle surmountable area, according to the surmountable
  • the parameters of the leap-over obstacle and the corresponding relationship implement the corresponding obstacle-crossing mode.
  • the obstacle-crossing mode corresponding to the parameter can be selected according to the parameter of the surmountable obstacle, and the selected obstacle-breaking mode can be executed.
  • different obstacle clearance modes can be set according to the parameters of different surmountable obstacles.
  • the parameter thresholds of the surmountable obstacles include the cross-sectional shape of the obstacle as a trapezoid and the height of the first threshold of 2.7cm, the cross-sectional shape of the obstacle as a rectangle and the height of the second threshold of 2cm, and the cross-sectional shape of the obstacle as an arc and the height is the third threshold of 2.2cm, if the user sets the obstacle parameter with a height higher than the first threshold via the user equipment, then it can be determined according to the parameter of the surmountable obstacle set by the user and the aforementioned obstacle parameter threshold The obstacle cannot be crossed. Therefore, when the autonomous mobile device runs into the obstacle-surpassable area, it will not try to cross the obstacle. For example, it can perform obstacle avoidance processing such as escape mode and edge following mode, and the autonomous mobile device can Automatically marks the area on the map as impassable.
  • the autonomous mobile device can determine the obstacle according to the obstacle parameter set by the user and the aforementioned obstacle parameter threshold Objects can be surmounted. If the autonomous mobile device is stuck in the obstacle surmountable area, it will run in the obstacle surmountable mode. Exemplarily, the autonomous mobile device will follow the forward direction and the surmountable obstacle corresponding to the obstacle surmountable area. The lower edge of the slope of the type obstacle runs in the direction of a preset angle to cross the surmountable obstacle. That is, the autonomous mobile device runs along the oblique obstacle-crossing path shown in Figure 3d.
  • the autonomous mobile device can determine the obstacle according to the obstacle parameter set by the user and the aforementioned obstacle parameter threshold Objects can be surmounted. If the autonomous mobile device is stuck in the obstacle-surpassable area, it operates in obstacle-surpassing mode. For example, the autonomous mobile device moves back a certain distance, brakes one wheel and makes the other wheel go around the obstacle.
  • the braked wheel is rotated at an angle to allow the rotating wheel to step over or over an obstacle, keeping the previously rotating wheel stationary, while the previously braked wheel is rotated at an angle around the fixed wheel to allow the rotating wheel Stepping to or over an obstacle, that is, the autonomous mobile device operates with the flow chart of the obstacle surmounting mode shown in FIG. 7 .
  • the autonomous mobile device will It can be determined that the obstacle is surmountable. If the autonomous mobile device is stuck in the obstacle-surpassable area, it operates in a specific obstacle-surpassing mode. For example, the autonomous mobile device retreats a certain distance, increases its speed and uses The increased speed traverses the obstacle, ie the autonomous mobile device operates in the obstacle clearance mode shown in FIG. 4 .
  • the obstacle-crossable area is set with a predetermined path of the obstacle-crossing path and runs according to the predetermined path.
  • the user assists in marking obstacles on the map and setting obstacle parameters, and determines that obstacles can be crossed based on the obstacle parameters.
  • the path suitable for the marked obstacles is planned based on the marked map. In this way, the risk of being trapped that the autonomous mobile device may encounter during unnecessary attempts to cross obstacles can be avoided, and the The time consumed by autonomous mobile equipment in unnecessary obstacle-crossing processing can ensure the stability of equipment operation and improve work efficiency.
  • the autonomous mobile device when the autonomous mobile device is stuck in the obstacle-surpassable area, the autonomous mobile device operates in an obstacle-surpassing mode with a higher probability of overcoming obstacles, thereby increasing the probability of the autonomous mobile device overcoming obstacles.
  • step S130 the following steps are also performed:
  • step S140 it is judged whether the autonomous mobile device has passed the obstacle-surpassable area.
  • the autonomous mobile device After executing all the steps of the control method shown in Figure 1a, as described in Figures 1b and 1c, it is also judged whether the autonomous mobile device has passed the obstacle-crossable area, for example, by judging whether the autonomous mobile device is in the If it is stuck in the obstacle-crossing area, it is judged whether the autonomous mobile device has passed the obstacle-crossable area. If it is judged that the autonomous mobile device is stuck in the obstacle-crossable area, it is judged that the autonomous mobile device has not passed the obstacle-crossable area; , if it is determined that the autonomous mobile device is not stuck in the obstacle-surpassable area, it is determined that the autonomous mobile device has passed the obstacle-surmountable area.
  • the method of judging whether the autonomous mobile device is stuck can refer to the previous description, and due to space limitation, details will not be repeated here.
  • step S140 if the determination is "No" in step S140, the autonomous mobile device has not passed the obstacle-surpassable area even if it is running in the obstacle-surpassing mode. The area is re-marked as an impassable area.
  • the autonomous mobile device when the autonomous mobile device operates in the obstacle surmounting mode to try to overcome the obstacle and fails, in order to improve work efficiency, the autonomous mobile device can try other paths, such as executing the escape mode, edge following mode, etc.
  • the obstacle surmounting mode includes: making the autonomous mobile device follow the forward travel direction of the autonomous mobile device along the slope of the surmountable obstacle corresponding to the obstacle surmountable area The lower edge of the face runs in a direction at a preset angle to cross over a surmountable obstacle.
  • the preset angle may include, but not limited to, any angle within the interval [10°, 45°], for example.
  • the autonomous mobile device can use the A-Star (also written as A*) algorithm to plan the path.
  • the autonomous mobile device uses the A* algorithm to plan the path
  • the search point is located in the obstacle-surpassing area (such as the threshold area)
  • the cost of the oblique search method is set to be lower than the cost of the horizontal and vertical search methods, so that The path planned by the autonomous mobile device tends to pass through the obstacle-surpassing area obliquely, that is, the planned path is modified from a horizontal and vertical obstacle-crossing path to an oblique obstacle-crossing path.
  • the path in the obstacle-surpassable area 240 tends to pass through the obstacle-surpassable area 240 along a direction of 45 degrees.
  • the angle between the forward direction of the autonomous mobile device and the obstacle 230 is 45°.
  • the autonomous mobile device when the autonomous mobile device fails to cross the obstacle-surpassable area with the above-mentioned oblique obstacle-surpassing path, it can continue to use another oblique obstacle-surpassing path (the corresponding predetermined angle is different from the previous oblique obstacle-surpassing path) Try again to cross the accessible area.
  • the autonomous mobile device runs along a direction in which the forward travel direction forms a preset angle with the lower edge of the slope of the surmountable obstacle corresponding to the obstacle-surpassable area to perform obstacle-surpassing processing and fails, the preset can be changed.
  • the forward travel direction of the autonomous mobile device and the lower edge of the slope of the surmountable obstacle corresponding to the obstacle-surpassing area form a changed preset angle to perform obstacle-surpassing processing again.
  • the mode corresponding to the predetermined path that the autonomous mobile device can plan may include special modes in the prior art such as a bow-shaped coverage mode, an edge mode, a navigation mode, and an escape mode. Due to space limitation, this disclosure will not describe it any further.
  • Fig. 9 shows a block diagram of a control device of an autonomous mobile device according to an exemplary embodiment.
  • the control apparatus 1100 of the autonomous mobile device may include an acquiring unit 1110 , a judging unit 1120 and a processing unit 1130 .
  • the obtaining unit 1110 is used to obtain a map marked with obstacle-surpassable areas.
  • the judging unit 1120 is used to judge whether the autonomous mobile device is stuck in the obstacle-surpassable area.
  • the processing unit 1130 is connected to the judging unit 1120, and is configured to command the autonomous mobile device to execute an obstacle-crossing mode in order to try to pass the obstacle-crossable area when it is judged that the autonomous mobile device is stuck in the obstacle-crossable area. Obstacle clearance area.
  • the judging unit 1120 is configured to: judge whether the autonomous mobile device runs to the obstacle-crossable area; Next, continue to judge whether the autonomous mobile device is stuck in the obstacle-passable area, wherein, if it is determined that the autonomous mobile device is stuck in the obstacle-passable area, the processing unit 1130 instructs the The autonomous mobile device executes an obstacle surmounting mode to try to pass through the obstacle surmountable area.
  • the judging unit 1120 is configured to: judge whether the autonomous mobile device is stuck; if it is judged that the autonomous mobile device is stuck, continue to judge that the autonomous mobile device is stuck Whether the stuck position is within the obstacle-surmountable area, wherein, if it is determined that the autonomous mobile device is stuck within the obstacle-surpassable area, the processing unit 1130 instructs the autonomous mobile device to Executing an obstacle clearance mode to attempt to pass through the obstacle clearance area.
  • the judging unit 1120 also judges whether the autonomous mobile device has passed the obstacle-crossable area; if it is judged that the autonomous mobile device has not passed the obstacle-crossable area, Obstacle traversable areas that have not been passed are remarked as impassable areas on the map.
  • the processing unit 1130 when it is determined that the location where the autonomous mobile device is stuck is not within the obstacle-surpassable area, the processing unit 1130 commands the autonomous mobile device to execute the escape mode, alarm, and /or mark the stuck position on the map as a common obstacle or mark the area where the stuck position is located as an impassable area.
  • the processing unit 1130 commands the autonomous mobile device to run in a workspace without a map and establishes a map of the workspace; the judging unit 1120 judges whether the autonomous mobile device is stuck; If it is judged that the autonomous mobile device is stuck at the current position, the processing unit 1130 commands the autonomous mobile device to execute the obstacle-crossing mode; after the autonomous mobile device executes the obstacle-crossing mode, the judging unit 1120 judges that the autonomous mobile device Whether the mobile device has passed the area corresponding to the position where the autonomous mobile device is stuck; if it is determined that the autonomous mobile device has passed the area corresponding to the position where the autonomous mobile device is stuck, marking the area on the created map as an obstacle traversable area; and/or in the event that the autonomous mobile device is determined not to have passed through the area corresponding to the location where the autonomous mobile device is stuck, The created map marks the area as impassable.
  • the acquiring unit 1110 also acquires parameters of surmountable obstacles in the obstacle-surpassable area.
  • the obtaining unit 1110 is configured to: push the map of the workspace to the user; and receive the map on which the user has marked the obstacle-surpassable area.
  • a recommendation unit (not shown), configured to recommend to the user to mark the surmountable obstacle in the obstacle-surpassable area after the map of the workspace is pushed to the user predetermined shape.
  • the judging unit 1120 also judges whether the autonomous mobile device can surmount the surmountable obstacle according to the parameters of the surmountable obstacle, wherein, after judging that the surmountable obstacle can be In the case of a surmountable obstacle, the processing unit 1130 instructs the autonomous mobile device to execute an obstacle surmounting mode, so as to try to pass through the obstacle surmountable area.
  • the obstacle surmounting mode includes: making the autonomous mobile device form a preset angle with the lower edge of the slope of the surmountable obstacle corresponding to the obstacle surmountable area along the forward traveling direction run in the direction to cross the surmountable obstacle.
  • the preset angle is not less than 10° and not greater than 45°.
  • the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from the current position; braking the second driving mechanism, and making the first driving mechanism rotate around the second driving mechanism; The mechanism is rotated forward by a first angle, wherein the first drive mechanism and the second drive mechanism are arranged side by side on the autonomous mobile device; the first drive mechanism is fixed, and the second drive mechanism is rotated around the The first driving mechanism rotates forward by a second angle.
  • the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from the stuck current position; accelerating the autonomous mobile device to a first preset speed, and The first preset speed crosses the surmountable obstacle, wherein the first preset speed is greater than the speed of the autonomous mobile device during normal operation.
  • the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from a stuck current position; The direction is the initial direction, rotate the first set angle in situ along the first rotation direction, and then control the motion unit of the autonomous mobile device to move forward while rotating the second set angle along the second rotation direction, wherein the first The second direction of rotation is opposite to the first direction of rotation.
  • the obstacle surmounting mode includes: making the autonomous mobile device retreat a second distance from a stuck current position; The direction is the initial direction, rotate in situ at a third set angle along the third rotation direction, and then control the motion unit of the autonomous mobile device to move forward a set distance in a straight line.
  • the parameter of the surmountable obstacle corresponds to the obstacle surmounting mode
  • the processing unit 1130 The parameters of the surmountable obstacle and the corresponding relationship execute a corresponding obstacle-crossing mode.
  • the parameters of the surmountable obstacle include shape and/or height.
  • Figure 10 shows a block diagram of an autonomous mobile device, according to an exemplary embodiment.
  • the autonomous mobile device 1200 may include a control device 1100 and a motion unit 1210 of the autonomous mobile device.
  • the movement unit 1210 is connected with the control device 1100, and is used for responding to the control device 1100 commanding the autonomous mobile device 1200 to execute an obstacle-crossing mode, and to try to pass through the obstacle-crossing area by moving in the obstacle-crossing mode.
  • the exercise unit 1210 may include, but is not limited to, a wheel set, for example.

Abstract

An autonomous mobile device, a control method therefor, an apparatus, and a storage medium. The method comprises: an acquisition step for acquiring a map marked with an obstacle crossing area (S110); a determination step for determining whether an autonomous mobile device is stuck in the obstacle crossing area (S120); and a handling step for commanding the autonomous mobile device to initiate an obstacle crossing mode when it is determined that the autonomous mobile device is stuck in the obstacle crossing area, so as to attempt to pass through the obstacle crossing area (S130). Therefore, obstacle crossing is assisted by means of the map marked with the obstacle crossing area, and as a consequence the problem caused by an inability to distinguish a crossable obstacle from a dangerous hazard area can be avoided.

Description

自主移动设备及其控制方法和装置以及存储介质Autonomous mobile equipment, its control method and device, and storage medium 技术领域technical field
本公开涉及智能家居技术领域,尤其涉及一种自主移动设备及其控制方法和装置以及存储介质。The present disclosure relates to the technical field of smart home, and in particular to an autonomous mobile device, a control method and device thereof, and a storage medium.
背景技术Background technique
随着科技进步和生活水平的提高,具有不同功能的自主移动设备越来越多地进入了人们的家庭,例如自主移动设备、陪伴型移动机器人等,让人们的生活更加舒适和方便。With the advancement of science and technology and the improvement of living standards, more and more autonomous mobile devices with different functions have entered people's homes, such as autonomous mobile devices, accompanying mobile robots, etc., making people's lives more comfortable and convenient.
自主移动设备是指在设定工作区域内自主执行预设任务的智能设备,目前自主移动设备通常包括但不限于清洁机器人(例如智能扫地机、智能擦地机、擦窗机器人)、陪伴型移动机器人(例如智能电子宠物、保姆机器人)、服务型移动机器人(例如酒店、旅馆、会晤场所的接待机器人)、工业巡检智能设备(例如电力巡检机器人、智能叉车等)、安防机器人(例如家用或商用智能警卫机器人)等。Autonomous mobile devices refer to smart devices that autonomously perform preset tasks within a set working area. At present, autonomous mobile devices usually include but are not limited to cleaning robots (such as smart sweepers, smart floor mopping machines, window cleaning robots), accompanying mobile Robots (such as smart electronic pets, nanny robots), service mobile robots (such as hotels, hotels, reception robots in meeting places), industrial inspection smart devices (such as power inspection robots, smart forklifts, etc.), security robots (such as household Or commercial intelligent guard robot), etc.
自主移动设备的运动单元(也称为驱动机构)通常是轮子或履带等通过转动带动自主移动设备在平面上运动的部件,这就导致自主移动设备会被一些特定的障碍物(比如门槛、玻璃门的滑轨、或室内铺设的具有一定高度的地垫的边缘部分)阻挡而无法越过这类障碍物,甚至会被这类障碍物卡住,导致其无法脱离该障碍物导致的困境。为区别于能够阻挡自主移动设备前进的普通障碍物(比如墙、冰箱、立式空调、落地橱柜等),将比如门槛等的这种障碍物称为可跨越型障碍物。The motion unit (also known as the driving mechanism) of the autonomous mobile device is usually a part such as a wheel or a track that drives the autonomous mobile device to move on a plane through rotation, which causes the autonomous mobile device to be blocked by some specific obstacles (such as thresholds, glass, etc.) The slide rail of the door, or the edge part of the floor mat with a certain height laid indoors) blocks and cannot cross this type of obstacle, or even be stuck by this type of obstacle, causing it to be unable to escape from the predicament caused by this obstacle. In order to distinguish it from ordinary obstacles (such as walls, refrigerators, vertical air conditioners, floor cabinets, etc.) that can block the progress of autonomous mobile devices, such obstacles such as thresholds are called surmountable obstacles.
目前自主移动设备通常都是使用自主移动设备上的各类传感器检测可跨越型障碍物。在现有技术中通常是通过自主移动设备的前置摄像头或测距传感器(比如激光雷达)识别其前方地面上特定的可跨越型障碍物,在判断其前方障碍物为可跨越型障碍物后,做出相应的动作来进行越障处理(本公开中的越障处理是指用于越过可跨越型障碍物的处理)。At present, autonomous mobile devices usually use various sensors on autonomous mobile devices to detect surmountable obstacles. In the prior art, the front camera or ranging sensor (such as lidar) of the autonomous mobile device is usually used to identify a specific surmountable obstacle on the ground in front of it, and after judging that the obstacle in front of it is a surmountable obstacle , make corresponding actions to perform obstacle-surmounting processing (obstacle-surmounting processing in this disclosure refers to processing for surmounting surmountable obstacles).
如果前置摄像头识别到障碍物是门槛或具有一定高度的地垫等可跨越型障碍物和/或利用测距传感器(比如设置在自主移动设备前部且斜向下发射激光的激光雷达可以基于几何运算检测自主移动设备前方一定距离处的障碍物的高度)检测到障碍物的高度低于某高度阈值比如2.7cm,则该障碍物属于可跨越型障碍物,自主移动设备可以做出相应的动作来进行越障处理。If the front camera recognizes that the obstacle is a surmountable obstacle such as a threshold or a floor mat with a certain height and/or using a ranging sensor (such as a lidar placed on the front of the autonomous mobile device and emitting Geometric calculation detects the height of an obstacle at a certain distance in front of the autonomous mobile device) If the height of the detected obstacle is lower than a certain height threshold such as 2.7cm, the obstacle is a surmountable obstacle, and the autonomous mobile device can make corresponding Action to perform obstacle handling.
上述通过摄像头或测距传感器协助自主移动设备越过可跨越型障碍物的方法都有一定的局限性。其中,第一种方法的前置摄像头虽然可能识别出门槛或地垫边缘,但是受处理器的计算能力的限制以及难以通过照片识别物体高度的传感器固有难题,会导致对可跨越型障碍物的识别成功率有限,经常导致误检测;针对第二种方法,受处理器的计算能力的限制以及外部环境光线、地面材质颜色等的影响,也会导致激光雷达对可跨越型障碍物的检测精度较低。The above-mentioned methods of assisting autonomous mobile devices to overcome surmountable obstacles through cameras or ranging sensors all have certain limitations. Among them, although the front camera of the first method may recognize the threshold or the edge of the floor mat, it is limited by the computing power of the processor and the inherent problem of the sensor that it is difficult to identify the height of the object through the photo, which will lead to the detection of obstacles that can be crossed. The recognition success rate is limited, which often leads to false detections; for the second method, due to the limitation of the computing power of the processor and the influence of external ambient light and ground material color, etc., it will also lead to the detection accuracy of lidar for surmountable obstacles. lower.
因此,尽管自动识别障碍物并进行越障处理可以使得自主移动设备更智能,但是由于家庭环境的复杂度很高以及现有技术的限制,在目前的状况下仍很难做到准确地自动区分可以越过的可跨越型障碍物和危险的困境区域(比如超过自主移动设备底盘高度的灯座容易将自主移动设备的底盘抬起使其运动单元比如轮组悬空,从而导致自主移动设备被卡住),这可能导致以下问题:自主移动设备可能在某些环境做出错误的处理,比如自主移动设备可能将通往阳台或厨房的玻璃门的滑轨识别为不可通过的普通障碍物而不对阳台或厨房进行清洁,从而导致用户体验变差,或由于误入困境区域导致自主移动设备被卡住的次数增多。Therefore, although automatic identification of obstacles and obstacle-surmounting processing can make autonomous mobile devices more intelligent, due to the high complexity of the home environment and the limitations of existing technologies, it is still difficult to accurately and automatically distinguish Spanable obstacles that can be crossed and dangerous dilemma areas (such as lamp holders that exceed the height of the chassis of the autonomous mobile device can easily lift the chassis of the autonomous mobile device and make its motion units such as the wheel set suspended in the air, resulting in the autonomous mobile device being stuck ), which may lead to the following problems: the autonomous mobile device may make incorrect handling in certain environments, such as the autonomous mobile device may recognize the sliding rail of the glass door leading to the balcony or the kitchen as an impassable common obstacle instead of the balcony or kitchen cleaning, resulting in a poor user experience, or an increased number of autonomous mobile devices getting stuck due to straying into troubled areas.
也就是说,现有技术披露的直接使用自主移动设备的相应传感器来协助越过障碍物有明显的局限性。That is to say, the direct use of the corresponding sensors of the autonomous mobile device disclosed in the prior art to assist in surmounting obstacles has obvious limitations.
发明内容Contents of the invention
有鉴于此,本公开提出了一种自主移动设备及其控制方法和装置以及存储介质。In view of this, the present disclosure proposes an autonomous mobile device, a control method and device thereof, and a storage medium.
根据本公开的第一方面,提供了一种自主移动设备的控制方法,所述控制方法包括:获取步骤,用于获取标记有可越障区域的地图;判断步骤,用于判断所述自主移动设备是否在所述可越障区域被卡住;处理步骤,用于在判断为所述自主移动设备在所述可越障区域被卡住的情况下,命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。According to the first aspect of the present disclosure, there is provided a control method of an autonomous mobile device, the control method comprising: an acquisition step, used to acquire a map marked with an obstacle surmountable area; a judging step, used to judge the autonomous movement Whether the device is stuck in the obstacle surmountable area; a processing step for ordering the autonomous mobile device to execute an obstacle surmounting mode when it is determined that the autonomous mobile device is stuck in the obstacle surmountable area , to try to pass through the obstacle-traversable area.
根据本公开的第二方面,提供了一种自主移动设备的控制装置,所述控制装置包括:获取单元,用于获取标记有可越障区域的地图;判断单元,用于判断所述自主移动设备是否在所述可越障区域被卡住;处理单元,用于在判断为所述自主移动设备在所述可越障区域被卡住的情况下,命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。According to a second aspect of the present disclosure, there is provided a control device for an autonomous mobile device, the control device includes: an acquisition unit for acquiring a map marked with an obstacle-surpassable area; a judging unit for judging the autonomous movement Whether the device is stuck in the obstacle surmountable area; a processing unit, configured to order the autonomous mobile device to execute an obstacle surmounting mode if it is determined that the autonomous mobile device is stuck in the obstacle surmountable area , to try to pass through the obstacle-traversable area.
根据本公开的第三方面,提供了一种自主移动设备的控制装置,所述控 制装置包括:处理器;用于存储处理器可执行指令的存储器;其中,所述处理器被配置为执行上述控制方法。According to a third aspect of the present disclosure, there is provided a control device for an autonomous mobile device, the control device comprising: a processor; a memory for storing instructions executable by the processor; wherein the processor is configured to execute the above-mentioned Control Method.
根据本公开的第四方面,提供了一种自主移动设备,所述自主移动设备包括:上述控制装置;以及运动单元,用于响应于所述控制装置命令所述自主移动设备执行越障模式,以所述越障模式运动以尝试通过所述可越障区域。According to a fourth aspect of the present disclosure, there is provided an autonomous mobile device, the autonomous mobile device comprising: the control device described above; and a motion unit, configured to respond to the control device instructing the autonomous mobile device to perform an obstacle surmounting mode, moving in the obstacle clearance mode in an attempt to pass through the obstacle clearance area.
根据本公开的第五方面,提供了一种非临时性计算机可读存储介质,当所述存储介质中的指令由处理器执行时,使得所述处理器能够执行上述控制方法。According to a fifth aspect of the present disclosure, there is provided a non-transitory computer-readable storage medium. When the instructions in the storage medium are executed by a processor, the processor can execute the above control method.
根据本公开,获取标记有(可跨越型障碍物所在的)可越障区域的地图,并且在自主移动设备在该可越障区域被卡住的情况下,命令自主移动设备执行越障模式,以尝试通过该可越障区域。这样,相比于现有技术中的直接使用自主移动设备的相应传感器比如前置摄像头或测距传感器来协助越过障碍物,本公开借助于标记有可越障区域的地图来协助越过障碍物,这样,能够避免由于无法准确地区分可跨越型障碍物和危险的困境区域所导致的前文所描述的问题。According to the present disclosure, obtaining a map marked with an obstacle traversable area (where a surmountable obstacle is located), and instructing the autonomous mobile device to execute an obstacle traversal mode in case the autonomous mobile device becomes stuck in the obstacle traversable area, to try to pass through the obstacle-passable area. In this way, compared to the prior art that directly uses the corresponding sensors of the autonomous mobile device, such as the front camera or the ranging sensor, to assist in overcoming obstacles, the present disclosure assists in overcoming obstacles by means of a map marked with obstacle-surpassable areas, In this way, the problems described above caused by the inability to accurately distinguish between surmountable obstacles and dangerous distressed areas can be avoided.
另外,无论是自主移动设备自动标记的可越障区域、还是用户手工标记的可越障区域,自主移动设备都可以先以越障模式尝试越过该可越障区域,从而在工作空间中尽可能的到达更多的位置,实现更多的功能。In addition, whether it is the obstacle-surpassable area marked automatically by the autonomous mobile device or the obstacle-surpassable area manually marked by the user, the autonomous mobile device can first try to cross the obstacle-surpassable area in the obstacle-surpassing mode, so that Reach more locations and achieve more functions.
根据下面参考附图对示例性实施例的详细说明,本公开的其它特征及方面将变得清楚。Other features and aspects of the present disclosure will become apparent from the following detailed description of exemplary embodiments with reference to the accompanying drawings.
附图说明Description of drawings
包含在说明书中并且构成说明书的一部分的附图与说明书一起示出了本公开的示例性实施例、特征和方面,并且用于解释本公开的原理。The accompanying drawings, which are incorporated in and constitute a part of the specification, illustrate exemplary embodiments, features, and aspects of the disclosure and, together with the specification, serve to explain the principles of the disclosure.
图1a~1c示出根据示例性实施例的自主移动设备的控制方法的流程图。Figures 1a-1c show a flowchart of a method of controlling an autonomous mobile device according to an exemplary embodiment.
图1d示出根据示例性实施例的自主移动设备建立地图的流程图。Fig. 1d shows a flow diagram of building a map by an autonomous mobile device according to an exemplary embodiment.
图2a示出根据示例性实施例的标记有可越障区域的地图的示意图。Fig. 2a shows a schematic diagram of a map marked with obstacle traversable areas according to an exemplary embodiment.
图2b~2e示出根据示例性实施例的作为可跨越型障碍物的门槛的示意图。Figures 2b-2e show schematic diagrams of a threshold as a surmountable obstacle according to an exemplary embodiment.
图3a示出根据示例性实施例的障碍物区域的栅格地图的代价分布的示意图。Fig. 3a shows a schematic diagram of a cost distribution of a grid map of obstacle areas according to an exemplary embodiment.
图3b示出根据示例性实施例的非障碍物区域的栅格地图的代价分布的示意图。Fig. 3b shows a schematic diagram of a cost distribution of a grid map of non-obstacle areas according to an exemplary embodiment.
图3c示出根据示例性实施例的未调整位于可越障区域内的点的搜索方 式而规划的路径的示意图。Fig. 3c shows a schematic diagram of a planned path according to an exemplary embodiment without adjusting the search method for points located in the obstacle-surpassable area.
图3d示出根据示例性实施例的调整了位于可越障区域内的点的搜索方式而规划的路径的示意图。Fig. 3d shows a schematic diagram of a planned path according to an exemplary embodiment after adjusting the search method for points located in the obstacle-surpassable area.
图3e示出根据示例性实施例的自主移动设备与障碍物之间的角度的示意图。Fig. 3e shows a schematic diagram of the angle between an autonomous mobile device and an obstacle according to an exemplary embodiment.
图4~7a示出根据示例性实施例的自主移动设备以越障模式运行的流程图。4-7a illustrate a flow diagram of an autonomous mobile device operating in an obstacle clearance mode, according to an exemplary embodiment.
图7b~7e示出根据示例性实施例的自主移动设备以图7a所示的越障模式运行以尝试越过门槛的示意图。Figures 7b-7e illustrate schematic diagrams of an autonomous mobile device operating in the obstacle clearance mode shown in Figure 7a to attempt to cross a threshold, according to an exemplary embodiment.
图8a~8b示出根据示例性实施例的自主移动设备以越障模式运行的示意图。Figures 8a-8b show schematic diagrams of an autonomous mobile device operating in an obstacle clearance mode according to an exemplary embodiment.
图9示出根据示例性实施例的自主移动设备的控制装置的框图。Fig. 9 shows a block diagram of a control device of an autonomous mobile device according to an exemplary embodiment.
图10示出根据示例性实施例的自主移动设备的框图。Figure 10 shows a block diagram of an autonomous mobile device, according to an exemplary embodiment.
具体实施方式Detailed ways
以下将参考附图详细说明本公开的各种示例性实施例、特征和方面。附图中相同的附图标记表示功能相同或相似的元件。尽管在附图中示出了实施例的各种方面,但是除非特别指出,不必按比例绘制附图。Various exemplary embodiments, features, and aspects of the present disclosure will be described in detail below with reference to the accompanying drawings. The same reference numbers in the figures indicate functionally identical or similar elements. While various aspects of the embodiments are shown in drawings, the drawings are not necessarily drawn to scale unless specifically indicated.
在这里专用的词“示例性”意为“用作例子、实施例或说明性”。这里作为“示例性”所说明的任何实施例不必解释为优于或好于其它实施例。The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration." Any embodiment described herein as "exemplary" is not necessarily to be construed as superior or better than other embodiments.
另外,为了更好的说明本公开,在下文的具体实施方式中给出了众多的具体细节。本领域技术人员应当理解,没有某些具体细节,本公开同样可以实施。在一些实例中,对于本领域技术人员熟知的方法、手段、元件和电路未作详细描述,以便于凸显本公开的主旨。In addition, in order to better illustrate the present disclosure, numerous specific details are given in the following specific implementation manners. It will be understood by those skilled in the art that the present disclosure may be practiced without some of the specific details. In some instances, methods, means, components and circuits that are well known to those skilled in the art have not been described in detail so as to obscure the gist of the present disclosure.
如前文所描述的,对于使用自主移动设备的前置摄像头或测距传感器(例如激光雷达)来检测可跨越型障碍物的方法,由于这两种传感器存在如前所述的各种缺点以及可能存在探测盲区的问题,因此可能导致自主移动设备无法准确检测到可跨越型障碍物,从而使得自主移动设备未尝试穿过可跨越型障碍物进而导致未运行到本可以运行到的区域,或者使自主移动设备错误识别可跨越型障碍物导致多次碰撞普通障碍物进而导致自主移动设备自身损害或对普通障碍物(比如家具)造成损伤。因此,单纯采用摄像头或测距传感器的方式难以准确判断例如门槛、玻璃门的滑轨、地垫边缘等可跨越型障碍物。As described above, for the method of using the front camera or ranging sensor (such as lidar) of an autonomous mobile device to detect surmountable obstacles, due to the various shortcomings of these two sensors and the possible There is a problem of detection blind zone, so the autonomous mobile device may not be able to accurately detect the surmountable obstacle, so that the autonomous mobile device does not try to pass through the surmountable obstacle and thus does not travel to the area it could have traveled to, or makes the The autonomous mobile device misidentifies the surmountable obstacle, which leads to multiple collisions with common obstacles, resulting in damage to the autonomous mobile device itself or damage to common obstacles (such as furniture). Therefore, it is difficult to accurately judge surmountable obstacles such as door sills, slide rails of glass doors, edges of floor mats, etc. simply by using a camera or a distance measuring sensor.
为此,考虑到如果自主移动设备能够知道哪里的障碍物是可以被越过的可跨越型障碍物,那么自主移动设备只需要确保自身在可跨越型障碍物对应的可越障区域内能够做出正确的越障处理即可通过该可越障区域,而不必担心前文所描述的各种问题。For this reason, considering that if the autonomous mobile device can know where the obstacle is a surmountable obstacle that can be crossed, then the autonomous mobile device only needs to ensure that it can make The correct obstacle-crossing process can pass through the obstacle-crossable area without worrying about the various problems described above.
此外,随着视觉SLAM(同时定位与地图构建,是Simultaneously Localization and Mapping的简称)和激光SLAM技术的发展,自主移动设备在家庭环境的实时定位已经变得越来越容易,一旦自主移动设备具有家庭环境的地图,并且用户通过APP将可跨越型障碍物对应的可越障区域在地图上标记出来并发送给自主移动设备,那么自主移动设备就可以准确地确定出该可越障区域,使自主移动设备能够在该可越障区域按预设的越障模式运行,从而较容易地越过可跨越型障碍物所在的可越障区域。In addition, with the development of visual SLAM (Simultaneously Localization and Mapping, Simultaneously Localization and Mapping) and laser SLAM technology, the real-time positioning of autonomous mobile devices in the home environment has become easier and easier. The map of the home environment, and the user marks the obstacle-surpassable area corresponding to the surmountable obstacle on the map through the APP and sends it to the autonomous mobile device, then the autonomous mobile device can accurately determine the obstacle-surpassable area, so that The autonomous mobile device can operate in the obstacle-crossing area according to the preset obstacle-crossing mode, so as to easily cross the obstacle-crossing area where the crossable obstacle is located.
另外,自主移动设备可实时检测自身在正常运行模式下是否越过了可跨越型障碍物(比如通过检测自身是否在可越障区域被卡住来检测自身是否越过了可跨越型障碍物),当检测到自身未越过可跨越型障碍物时,自主移动设备以更可能越过可跨越型障碍物的特定的越障模式在可越障区域运行,以提高自主移动设备越过可跨越型障碍物的概率。In addition, the autonomous mobile device can detect in real time whether it has crossed a surmountable obstacle in normal operation mode (for example, by detecting whether it is stuck in the surmountable area to detect whether it has crossed a surmountable obstacle), when When it detects that it has not crossed a surmountable obstacle, the autonomous mobile device operates in a specific obstacle-crossing mode that is more likely to cross the traversable obstacle, so as to increase the probability of the autonomous mobile device crossing the surmountable obstacle .
基于上述构思,提出图1a~1c所示的本示例性实施例的自主移动设备的控制方法。该自主移动设备例如可包括但不限于清洁机器人(例如智能扫地机、智能擦地机、擦窗机器人)、陪伴型移动机器人(例如智能电子宠物、保姆机器人)、服务型移动机器人(例如酒店、旅馆、会晤场所的接待机器人)、工业巡检智能设备(例如电力巡检机器人、智能叉车等)、安防机器人(例如家用或商用智能警卫机器人)等可自主移动的智能设备。本实施例的控制方法的执行主体例如可以包括但不限于自主移动设备的控制单元、自主移动设备的外置设备等。Based on the above ideas, the control method of the autonomous mobile device of this exemplary embodiment shown in Figs. 1a-1c is proposed. Such autonomous mobile devices may include, but are not limited to, cleaning robots (such as smart sweepers, smart mopping machines, window cleaning robots), companion mobile robots (such as smart electronic pets, nanny robots), service mobile robots (such as hotels, Reception robots in hotels and meeting places), industrial inspection intelligent equipment (such as power inspection robots, intelligent forklifts, etc.), security robots (such as household or commercial intelligent security robots) and other intelligent devices that can move autonomously. The execution subject of the control method in this embodiment may include, but not limited to, a control unit of the autonomous mobile device, an external device of the autonomous mobile device, and the like, for example.
请参阅图1a~1c,本示例性实施例的控制方法可以包括如下步骤:Referring to Figures 1a-1c, the control method of this exemplary embodiment may include the following steps:
在步骤S110中,获取标记有可越障区域的地图。其中,可越障区域可表示可跨越型障碍物在地图中的对应区域。In step S110, a map marked with obstacle-surpassing areas is obtained. Wherein, the obstacle surmountable area may represent a corresponding area in the map of the surmountable obstacle.
在一种可能的实现方式中,自主移动设备可从自身的存储单元(比如内部存储设备或器件)直接获取预先存储的标记有可越障区域的地图。In a possible implementation manner, the autonomous mobile device may directly acquire a pre-stored map marked with obstacle-surpassable areas from its own storage unit (such as an internal storage device or device).
本示例性实施例中,自主移动设备曾经对某工作空间执行了工作任务(比如清洁机器人执行了清洁任务),在工作任务的执行过程中,自主移动设备建立并存储了该工作空间的初始地图(比如在自身的存储单元中存储该工作空间的初始地图),在该初始地图中标记表示可跨越型障碍物所占据区 域对应的可越障区域(可以通过人工标记或处理单元自动标记),成为标记有可越障区域的地图,并将其进行存储,这样,在依据本实施例的控制方法对同一工作空间执行后续工作任务时,该自主移动设备可从自身的存储单元直接获取标记有可越障区域的地图。或者其它自主移动设备可以通过网络从存储有上述地图的自主移动设备的存储单元或存储有上述地图的服务器中获取上述地图。In this exemplary embodiment, the autonomous mobile device once performed a work task on a certain workspace (for example, a cleaning robot performed a cleaning task), and during the execution of the work task, the autonomous mobile device established and stored an initial map of the workspace (such as storing the initial map of the workspace in its own storage unit), marking in the initial map the obstacle-surpassable area corresponding to the area occupied by the surmountable obstacle (can be marked manually or automatically by the processing unit), Become a map marked with obstacle-crossable areas and store it, so that when performing follow-up work tasks on the same workspace according to the control method of this embodiment, the autonomous mobile device can directly obtain the marked area from its own storage unit. A map of the obstacle-traversable area. Alternatively, other autonomous mobile devices may acquire the map from a storage unit of the autonomous mobile device storing the map or a server storing the map through a network.
在一个实施例中,自主移动设备在工作空间中建立地图的同时可以自动将可越障区域标记在新建的地图上。可以通过执行图1d的各步骤来建立地图,如图1d所示,该建立地图的方法包括:In one embodiment, when the autonomous mobile device builds a map in the workspace, it can automatically mark the obstacle-surpassable area on the newly created map. The map can be established by executing the steps in Figure 1d, as shown in Figure 1d, the method for establishing the map includes:
在步骤S010中,命令自主移动设备在未建立地图的工作空间运行并且建立该工作空间的地图。In step S010, the autonomous mobile device is commanded to operate in an unmapped workspace and map the workspace.
在步骤S020中,在自主移动设备的运行过程中判断自主移动设备是否被卡住。若判断为自主移动设备被卡住,则步骤S020的判断为“是”,然后执行步骤S030。若判断为自主移动设备未被卡住,则继续执行步骤S020。In step S020, it is determined whether the autonomous mobile device is stuck during the operation of the autonomous mobile device. If it is determined that the autonomous mobile device is stuck, the determination in step S020 is "Yes", and then step S030 is executed. If it is determined that the autonomous mobile device is not stuck, proceed to step S020.
在步骤S030中,命令自主移动设备执行越障模式。然后,执行步骤S040。关于越障模式,将在后面描述。In step S030, the autonomous mobile device is commanded to execute the obstacle surmounting mode. Then, step S040 is executed. The obstacle clearance mode will be described later.
在步骤S040中,判断自主移动设备是否通过了与被卡住的位置相对应的区域。若判断为通过了自主移动设备被卡住的位置所对应的区域,则步骤S040的判断为“是”,然后执行步骤S050。若判断为未通过自主移动设备被卡住的位置所对应的区域,则步骤S040的判断为“否”,然后执行步骤S060。In step S040, it is judged whether the autonomous mobile device has passed the area corresponding to the stuck position. If it is determined that the area corresponding to the position where the autonomous mobile device is stuck has passed, the determination in step S040 is "Yes", and then step S050 is executed. If it is determined that the area corresponding to the position where the autonomous mobile device is stuck has not been passed, the determination in step S040 is "No", and then step S060 is executed.
在步骤S050中,在地图上将通过的区域(即,自主移动设备所通过的被卡住的位置所对应的区域)标记为可越障区域。In step S050 , mark the passed area (ie, the area corresponding to the stuck position passed by the autonomous mobile device) on the map as an obstacle-surpassable area.
在步骤S060中,在地图上将未通过的区域(即,自主移动设备未通过的被卡住的位置所对应的区域)标记为不可通过区域。In step S060, mark the failed area (that is, the area corresponding to the stuck position where the autonomous mobile device failed to pass) as an impassable area on the map.
通过上述自主移动设备亲自实地探测障碍物类型的方法(而非通过摄像头或激光雷达等远程非接触地探测障碍物),可以在建立地图阶段由自主移动设备自动识别可跨越型障碍物并在地图上标记可越障区域,同时避免了仅通过摄像头和/或测距传感器远距离探测可跨越型障碍物导致的识别不准确的问题。Through the above-mentioned method of autonomous mobile device detecting obstacle types in person (rather than remote non-contact detection of obstacles such as cameras or lidars), autonomous mobile devices can automatically identify surmountable obstacles and display them on the map during the map building phase. The obstacle-crossable area is marked on the top, and at the same time, the problem of inaccurate recognition caused by long-distance detection of surmountable obstacles only through the camera and/or distance measuring sensor is avoided.
应能够理解,自主移动设备也可采用现有技术中的相关适当方法来建立工作空间的地图(比如通过码盘、陀螺仪、加速度计等航位推算传感器以碰撞障碍物的方式来建立地图、通过摄像头或激光雷达配合航位推算传感器的SLAM来建立地图等),然后再在该已建立的地图上向用户提供由用户标记可 越障区域的选项,由用户选择可越障区域,从而指引自主移动设备在该指定(选择)的可越障区域执行后续指令。受篇幅所限,本示例性实施例对自主移动设备如何建立工作空间的地图以及如何在地图上标记可跨越区域不再具体展开。It should be understood that the autonomous mobile device may also use relevant and appropriate methods in the prior art to establish a map of the workspace (such as establishing a map by colliding with obstacles through dead reckoning sensors such as code discs, gyroscopes, and accelerometers, Use the camera or lidar to cooperate with the SLAM of the dead reckoning sensor to build a map, etc.), and then provide the user with the option to mark the obstacle-crossing area on the established map, and the user selects the obstacle-crossing area to guide The autonomous mobile device executes subsequent instructions in the designated (selected) obstacle-surpassable area. Due to limited space, this exemplary embodiment does not elaborate on how the autonomous mobile device builds a map of the workspace and how to mark crossable areas on the map.
对于自主移动设备能够识别的普通障碍物,比如基于自主移动设备未通过该自主移动设备之前被卡住的位置所对应的区域而识别该处障碍物为能够阻碍其通过的普通障碍物,或通过碰撞传感器的直接碰撞而明确其不可能通过的普通障碍物,或通过接近传感器检测到该障碍物的高度明显大于可通行阈值从而自主移动设备必然无法越过的普通障碍物,以及通过各传感器能够明确自主移动设备确实无法越过的普通障碍物,步骤S040的判断为“否”,自主移动设备在地图上将其标记为不可通过区域,从而使自主移动设备基于后续指令可以执行除越障模式之外的其它模式,比如执行脱困模式(比如先后退然后旋转,或重复执行旋转和后退,从而远离该障碍物)、边缘跟随模式(比如先旋转使其侧部朝向该障碍物并继续运行,同时以其侧部的接近传感器非接触地检测其侧部与障碍物的距离并使该距离持续保持在设定的距离范围内,从而使自主移动设备能够沿着障碍物的边缘运行并保持其与该障碍物之间持续具有一定的距离)等的避障处理。For ordinary obstacles that the autonomous mobile device can recognize, for example, based on the fact that the autonomous mobile device has not passed through the area corresponding to the location where the autonomous mobile device was stuck before, it is recognized that the obstacle is a common obstacle that can prevent it from passing, or by The direct collision of the collision sensor makes it clear that it is impossible to pass through ordinary obstacles, or the height of the obstacle detected by the proximity sensor is obviously greater than the passable threshold, so that the autonomous mobile device must not be able to cross the common obstacle, and through each sensor Can clearly The common obstacle that the autonomous mobile device cannot cross, the judgment of step S040 is "No", the autonomous mobile device marks it as an impassable area on the map, so that the autonomous mobile device can execute other than the obstacle-crossing mode based on subsequent instructions other modes, such as executing the escape mode (such as back and forth and then rotating, or repeatedly performing rotation and backing away from the obstacle), edge-following mode (such as first rotating so that its side faces the obstacle and continue running, and at the same time The proximity sensor on its side detects the distance between its side and the obstacle without contact and keeps the distance within the set distance range, so that the autonomous mobile device can run along the edge of the obstacle and keep its distance from the obstacle. There is a certain distance between obstacles) and other obstacle avoidance processing.
无论是自主移动设备自动标记的可越障区域、还是用户手工标记的可越障区域,自主移动设备都可以先以越障模式尝试越过该可越障区域,从而在工作空间中尽可能的到达更多的位置,实现更多的功能。Whether it is the obstacle-surpassable area marked automatically by the autonomous mobile device or the obstacle-surpassable area manually marked by the user, the autonomous mobile device can first try to cross the obstacle-surpassable area in the obstacle-surpassing mode, so as to reach as far as possible in the workspace More locations, more functions.
在一种可能的实现方式中,步骤S110可以包括:将工作空间的地图推送给用户;接收用户标记了可越障区域的地图。In a possible implementation manner, step S110 may include: pushing the map of the workspace to the user; and receiving the map in which the user has marked the obstacle-surpassable area.
本实施例中,对于通过用户辅助在地图上标记可越障区域的情况,自主移动设备可以经由无线网络将工作空间的地图推送给用户设备;用户从该地图上能够直观地看到可通行区域和障碍物区域,并且能够凭借用户自己的判断在该地图上将实际的工作空间中的可跨越型障碍物所处的区域标记为可越障区域;用户设备可以将用户标记了可越障区域的地图通过无线网络发送给自主移动设备,相应地,自主移动设备可以接收用户标记了可越障区域的地图。In this embodiment, for the situation where the obstacle-surpassable area is marked on the map with the assistance of the user, the autonomous mobile device can push the map of the workspace to the user device via the wireless network; the user can intuitively see the passable area from the map and obstacle areas, and can use the user's own judgment to mark the area where the surmountable obstacles in the actual workspace are located as the obstacle-surpassable area on the map; the user device can mark the user as the obstacle-surpassable area The map of the autonomous mobile device is sent to the autonomous mobile device through the wireless network. Correspondingly, the autonomous mobile device can receive the map where the user has marked the obstacle-surpassable area.
自主移动设备向用户设备推送的地图可以是初始地图,也可以是曾经标记过可越障区域的地图(既可以是由用户进行过标记也可以是由自主移动设备进行过标记)。用户既可以在地图上新建可越障区域,也可以对已标记的可越障区域进行修改和/或删除。The map pushed by the autonomous mobile device to the user device may be an initial map, or a map that has previously marked the obstacle-surpassable area (either marked by the user or marked by the autonomous mobile device). The user can not only create a new obstacle traversable area on the map, but also modify and/or delete the marked obstacle surmountable area.
当然,若自将地图推送给用户时起经过了设定时间用户还未标记可越障区域,则可以通过比如语音、图文消息等方式来提示用户在地图上标记可越障区域。Of course, if the user has not marked the obstacle-crossable area after the set time has elapsed since the map was pushed to the user, the user may be prompted to mark the obstacle-crossable area on the map by means such as voice or text message.
在一些实施例中,对于地图上所展示的障碍物,在一种实现方式中,用户需要根据自己的经验或产品手册提供的标准或参数判断这些障碍物是否能够被自主移动设备越过,一般而言,用户对于障碍物是否是能够被自主移动设备越过的可跨越型障碍物会有比较直观的判断,因此由用户标记可越障区域会比较准确;在另一种实现方式中,用户无需判断这些障碍物是否能够被自主移动设备越过,用户可对这些障碍物进行标记并注明这些障碍物各自的参数例如高度、形状等,自主移动设备可以自动根据这些障碍物参数来判断这些障碍物是否属于可跨越型障碍物(比如判断这些障碍物是否能够被自主移动设备越过)。In some embodiments, for the obstacles shown on the map, in an implementation, the user needs to judge whether these obstacles can be crossed by the autonomous mobile device according to his own experience or the standards or parameters provided by the product manual. In other words, the user will have a more intuitive judgment on whether the obstacle is a crossable obstacle that can be crossed by the autonomous mobile device, so it is more accurate for the user to mark the obstacle crossable area; in another implementation, the user does not need to judge Whether these obstacles can be crossed by the autonomous mobile device, the user can mark these obstacles and indicate the respective parameters of these obstacles such as height, shape, etc., and the autonomous mobile device can automatically judge whether these obstacles are based on these obstacle parameters. Belongs to surmountable obstacles (such as judging whether these obstacles can be surmounted by autonomous mobile devices).
当用户在地图上标记了可越障区域之后,用户设备可以获取标记有可越障区域的地图,进而在该自主移动设备执行本示例性实施例的控制方法时,该自主移动设备可与该用户设备建立通信连接,向该用户设备发送标记有可越障区域的地图的获取请求,该用户设备响应于该获取请求而将标记有可越障区域的地图发送至该自主移动设备,或者该用户设备按照预定周期来周期性地向该自主移动设备发送该标记有可越障区域的地图。After the user marks the obstacle-surpassable area on the map, the user equipment can obtain the map marked with the obstacle-surpassable area, and then when the autonomous mobile device executes the control method of this exemplary embodiment, the autonomous mobile device can interact with the The user equipment establishes a communication connection, and sends to the user equipment an acquisition request for a map marked with an obstacle-surpassable area, and the user equipment responds to the acquisition request and sends the map marked with an obstacle-surpassable area to the autonomous mobile device, or the user equipment The user equipment periodically sends the map marked with the obstacle-surpassable area to the autonomous mobile equipment according to a predetermined period.
用户设备可以包括但不限于能够与该自主移动设备建立通信连接且具有显示器的设备,比如手机、平板电脑等移动终端设备或服务器、台式机等终端设备等,该用户设备也可称为该自主移动设备的APP端设备。示例性的,该APP端设备可包括用于展示地图的显示器以及用于检测用户的标记动作的传感器(比如触摸屏),在该传感器检测到用户对于第一区域的标记动作时,该APP端设备可在所展示的地图上将该第一区域标记为可越障区域。User equipment may include, but is not limited to, devices capable of establishing a communication connection with the autonomous mobile device and having a display, such as mobile terminal devices such as mobile phones and tablet computers, or terminal devices such as servers and desktop computers. The user equipment may also be referred to as the autonomous mobile device. App-side devices for mobile devices. Exemplarily, the APP end device may include a display for displaying a map and a sensor (such as a touch screen) for detecting the user's marking action, and when the sensor detects the user's marking action on the first area, the APP end device This first area may be marked on the displayed map as an obstacle clearable area.
为便于理解“标记有可越障区域的地图”,以下以图2a所示的标记有可越障区域的地图为例进行说明。如图2a所示,在用户设备的显示器310中显示了标记有可越障区域的地图320,该地图320上标记了可越障区域340,可越障区域340中包括虚线示出的可跨越型障碍物330,该可跨越型障碍物330为诸如门槛等的可以被自主移动设备通过的障碍物。In order to facilitate the understanding of "the map marked with the obstacle-surpassable area", the map shown in Fig. 2a marked with the obstacle-surpassable area is taken as an example for description below. As shown in FIG. 2a, a map 320 marked with an obstacle-surpassable area is displayed on the display 310 of the user equipment, and an obstacle-surpassable area 340 is marked on the map 320. type obstacle 330, the surmountable obstacle 330 is an obstacle that can be passed by an autonomous mobile device, such as a threshold.
在一种可能的实现方式中,在将工作空间的地图推送给用户后,向用户推荐用以在可越障区域内标记可跨越型障碍物的预定形状,该预定形状例如可以代表相应的可跨越型障碍物的截面形状,由此,用户可以经由该预定形状来标记可越障区域,相应地,自主移动设备可以接收用户利用预定形状标 记了可越障区域的地图。In a possible implementation, after the map of the workspace is pushed to the user, the user is recommended a predetermined shape used to mark the surmountable obstacle in the obstacle-surpassable area. The predetermined shape may represent the corresponding surmountable obstacle, for example The cross-sectional shape of a leaping obstacle, whereby the user can mark the obstacle-surpassable area via the predetermined shape, and accordingly, the autonomous mobile device can receive the map in which the user marks the obstacle-surpassable area with the predetermined shape.
在一些实施例中,上述预定形状例如包括但不限于矩形、正方形、三角形、圆形、椭圆形、菱形、圆弧形等。应能够理解,本公开对预定形状的具体形状不作具体限制,只要是能够在初始地图上标记出可越障区域的预定形状,应均可用于本公开。In some embodiments, the aforementioned predetermined shapes include, but are not limited to, rectangles, squares, triangles, circles, ovals, rhombuses, circular arcs, and the like. It should be understood that the present disclosure does not specifically limit the specific shape of the predetermined shape, as long as the predetermined shape can mark the obstacle-surpassable area on the initial map, it should all be applicable to the present disclosure.
为便于理解“可跨越型障碍物”,以下以位于两个房间之间的门槛为例进行说明。对于位于两个房间之间的门槛,由于需要与房门底部相配合,通常会有斜坡(其横截面如图2b所示)、凸起(比如过门石,其横截面如图2c所示)和/或凹槽(比如玻璃门的滑轨,其横截面如图2d和图2e所示),在自主移动设备的正向行进方向与门槛相遇时,其移动机构可能会由于与门槛的斜坡、垂直面或凹槽相遇而被卡住,导致自主移动设备无法顺利(成功)越过门槛。In order to facilitate the understanding of "crossable obstacles", the following is an example of a threshold located between two rooms. For the threshold located between two rooms, due to the need to match with the bottom of the door, there are usually slopes (the cross section of which is shown in Figure 2b) and protrusions (such as the doorway stone, whose cross section is shown in Figure 2c) and/or grooves (such as the slide rail of a glass door, whose cross-section is shown in Figure 2d and Figure 2e), when the forward direction of travel of the autonomous mobile device meets the threshold, its moving mechanism may be due to the slope of the threshold. , vertical surfaces or grooves meet and get stuck, resulting in the autonomous mobile device not being able to smoothly (successfully) cross the threshold.
在获取标记有可越障区域的地图之后,执行下述步骤S120。After obtaining the map marked with the obstacle-surpassable area, the following step S120 is performed.
在步骤S120中,判断自主移动设备是否在可越障区域被卡住。In step S120, it is determined whether the autonomous mobile device is stuck in the obstacle-surpassable area.
自主移动设备被卡住所包括的情况包括但不限于:自主移动设备在通过较低矮的障碍物(比如较高的门槛或灯座)时,其底盘被这类障碍物托起导致轮子悬空空转,致使自主移动设备无法通过其运动单元的运转而继续运行;或者其轮子卡在门槛中的滑轨中(比如玻璃门的滑轨)不能运转导致自主移动设备也不能继续向前运动;或者其轮子陷入某种刚好能够容纳轮子的缝隙使轮子无法转动导致自主移动设备无法继续运行,以及其它类似的情况。Situations where the autonomous mobile device gets stuck include but are not limited to: when the autonomous mobile device passes through relatively low obstacles (such as high thresholds or light sockets), its chassis is lifted by such obstacles and the wheels are suspended in the air , so that the autonomous mobile device cannot continue to operate through the operation of its motion unit; or its wheels are stuck in the slide rails in the threshold (such as the slide rails of glass doors) and cannot operate, so that the autonomous mobile device cannot continue to move forward; or other Wheels getting stuck in some sort of gap just big enough to accommodate the wheels so the wheels can't turn and the autonomous mobile device can't continue to function, and other similar situations.
检测自主移动设备被卡住的通常方式是结合多个传感器的信息进行综合判断,比如可以通过轮组上的码盘判断自主移动设备的轮组是否在运转,同时根据测距传感器获取自主移动设备与周围固定障碍物之间的距离或根据摄像头获取周围环境照片,如果轮组在运转,但通过测距传感器获取的自主移动设备与周围固定障碍物之间的距离不发生变化,或通过摄像头拍摄的多张照片中的物体的变化以及物体之间相互关系的变化小于自主移动设备正常运行时多张照片中的物体的变化以及物体之间相互关系的变化,则可以说明自主移动设备被卡住。本领域技术人员应当理解,检测自主移动设备被卡住的方法不限于上述方法。The usual way to detect that the autonomous mobile device is stuck is to combine the information of multiple sensors to make a comprehensive judgment. For example, it is possible to judge whether the wheel set of the autonomous mobile device is running through the code disc on the wheel set, and at the same time obtain the information of the autonomous mobile device from the ranging sensor. The distance between the autonomous mobile device and the surrounding fixed obstacles or according to the camera to obtain the surrounding environment photos, if the wheel set is running, but the distance between the autonomous mobile device and the surrounding fixed obstacles obtained by the ranging sensor does not change, or through the camera If the change of the objects in multiple photos and the change of the mutual relationship between objects is smaller than that of the objects in multiple photos and the change of the mutual relationship between the objects when the autonomous mobile device is running normally, it can indicate that the autonomous mobile device is stuck . Those skilled in the art should understand that the method for detecting that the autonomous mobile device is stuck is not limited to the above methods.
在某些实施例中,如图1b所示的,步骤S120可以包括步骤S121和S122。In some embodiments, as shown in FIG. 1b, step S120 may include steps S121 and S122.
在步骤S121中,判断自主移动设备是否运行至可越障区域。若判断为自主移动设备运行至可越障区域,则执行步骤S122,否则,继续执行步骤S121。In step S121, it is judged whether the autonomous mobile device travels to the obstacle-surpassable area. If it is determined that the autonomous mobile device has run to the obstacle-surpassable area, then execute step S122, otherwise, continue to execute step S121.
在步骤S122中,继续判断自主移动设备是否在可越障区域被卡住。若判 断为自主移动设备在可越障区域被卡住,则在步骤S120中判断为自主移动设备在可越障区域被卡住,然后执行下述步骤S130;否则,自主移动设备按原运行模式继续运行,并继续执行步骤S121,判断自主移动设备是否运行出当前可越障区域或运行至其它的可越障区域。In step S122, continue to judge whether the autonomous mobile device is stuck in the obstacle-crossable area. If it is determined that the autonomous mobile device is stuck in the obstacle-surpassable area, then in step S120 it is determined that the autonomous mobile device is stuck in the obstacle-surpassable area, and then the following step S130 is performed; otherwise, the autonomous mobile device operates in the original operating mode Continue to run, and continue to execute step S121 to determine whether the autonomous mobile device runs out of the current obstacle-crossable area or travels to other obstacle-crossable areas.
在自主移动设备的运行过程中,当运行至地图上标记的可越障区域时,检测自主移动设备是否被卡住。示例性的,自主移动设备可根据其自身当前位置是否越过可越障区域的边界位置或自主移动设备的当前位置是否在可越障区域所覆盖的范围内来判断自主移动设备是否运行至可越障区域(即,执行步骤S121);如果判断为自主移动设备已运行至可越障区域,步骤S121判断为“是”,然后执行步骤S122以进一步判断自主移动设备是否在该可越障区域被卡住。如果判断为自主移动设备在该可越障区域被卡住,则步骤S122判断为“是”,因此步骤S120判断为“是”,因此执行下述步骤S130。During the operation of the autonomous mobile device, when running to the obstacle-crossable area marked on the map, it is detected whether the autonomous mobile device is stuck. Exemplarily, the autonomous mobile device can judge whether the autonomous mobile device is running to the point where the obstacle can be crossed according to whether its own current position has crossed the boundary position of the obstacle surmountable area or whether the current position of the autonomous mobile device is within the range covered by the obstacle surmountable area. If it is determined that the autonomous mobile device has moved to the obstacle-crossable area, step S121 is judged as "Yes", and then step S122 is executed to further determine whether the autonomous mobile device is in the obstacle-crossable area. stuck. If it is determined that the autonomous mobile device is stuck in the obstacle-crossable area, then step S122 is judged as "yes", so step S120 is judged as "yes", so the following step S130 is executed.
在某些实施例中,如图1c所示的,步骤S120可以包括步骤S123和S124。In some embodiments, as shown in Fig. 1c, step S120 may include steps S123 and S124.
在步骤S123中,判断自主移动设备是否被卡住。若判断为自主移动设备被卡住,则执行步骤S124,否则,继续执行步骤S123。检测自主移动设备被卡住的方式可参阅前文。In step S123, it is determined whether the autonomous mobile device is stuck. If it is determined that the autonomous mobile device is stuck, execute step S124, otherwise, continue to execute step S123. The way to detect that the autonomous mobile device is stuck can be found in the previous section.
在步骤S124中,继续判断自主移动设备被卡住的位置是否在可越障区域内。若判断为自主移动设备被卡住的位置在可越障区域内,则在步骤S120中判断为自主移动设备在可越障区域被卡住,然后执行下述步骤S130。否则,若判断为自主移动设备被卡住的位置不在可越障区域内,则执行步骤170,自主移动设备进行脱困模式和/或报警,如图1c所示;在有的实施例中,还可以在地图上将被卡住的位置标记为普通障碍物或将该被卡住的位置所在的区域标记为不可通过区域。In step S124, continue to judge whether the position where the autonomous mobile device is stuck is within the obstacle-surmountable area. If it is determined that the location where the autonomous mobile device is stuck is within the obstacle-crossable area, it is determined in step S120 that the autonomous mobile device is stuck in the obstacle-crossable area, and then the following step S130 is performed. Otherwise, if it is determined that the location where the autonomous mobile device is stuck is not within the obstacle-surpassable area, then step 170 is performed, and the autonomous mobile device performs a rescue mode and/or an alarm, as shown in Figure 1c; You can mark the stuck location as a normal obstacle or mark the area where the stuck location is located as an impassable area on the map.
在自主移动设备的运行过程中,实时检测自主移动设备是否被卡住,当自主移动设备被卡住时,检测自主移动设备被卡住的位置是否在地图上标记的可越障区域内。示例性的,自主移动设备可实时检测自主移动设备是否被卡住(即,执行步骤S123),如果判断为自主移动设备被卡住,步骤S123判断为“是”,执行步骤S124以进一步根据自主移动设备被卡住的位置是否在可越障区域的边界位置上或可越障区域的范围内来判断自主移动设备被卡住的位置是否在可越障区域内;如果判断为自主移动设备被卡住的位置在可越障区域内,则步骤S124判断为“是”,因此步骤S120判断为“是”,从而执行下述步骤S130。During the operation of the autonomous mobile device, it is detected in real time whether the autonomous mobile device is stuck, and when the autonomous mobile device is stuck, it is detected whether the stuck position of the autonomous mobile device is within the obstacle-crossing area marked on the map. Exemplarily, the autonomous mobile device can detect in real time whether the autonomous mobile device is stuck (that is, execute step S123), if it is determined that the autonomous mobile device is stuck, step S123 judges "Yes", and executes step S124 to further according to the autonomous mobile device Whether the position where the mobile device is stuck is on the boundary of the obstacle surmountable area or within the range of the obstacle surmountable area is used to judge whether the position where the autonomous mobile device is stuck is within the obstacle surmountable area; if it is judged that the autonomous mobile device is If the stuck position is within the obstacle-crossable area, step S124 is judged as "Yes", so step S120 is judged as "Yes", and the following step S130 is executed.
综上,在步骤S120判断为自主移动设备在可越障区域被卡住的情况下, 执行下述步骤S130。To sum up, if it is determined in step S120 that the autonomous mobile device is stuck in the obstacle-crossable area, the following step S130 is executed.
在步骤S130中,命令自主移动设备执行越障模式,以尝试通过可越障区域。In step S130, the autonomous mobile device is commanded to execute an obstacle surmounting mode, so as to try to pass through the obstacle surmountable area.
根据本示例性实施例的控制方法,获取标记有可越障区域的地图,并且在自主移动设备在该可越障区域被卡住的情况下,命令自主移动设备执行越障模式,以尝试通过可越障区域。由此,相比于现有技术中的直接使用自主移动设备的相应传感器比如前置摄像头或测距传感器来协助越过障碍物,本公开借助于标记有可越障区域的地图来协助越过障碍物,这样,能够避免由于无法准确地区分可跨越型障碍物和危险的困境区域所导致的前文所描述的问题。According to the control method of this exemplary embodiment, a map marked with an obstacle-surmountable area is obtained, and in the case that the autonomous mobile device is stuck in the obstacle-surpassable area, the autonomous mobile device is commanded to execute the obstacle-overpass mode in order to try to pass Obstacle traversable area. Therefore, compared with the prior art that directly uses the corresponding sensors of the autonomous mobile device, such as the front camera or the ranging sensor, to assist in overcoming obstacles, the present disclosure assists in overcoming obstacles by means of a map marked with areas that can be surmounted , in this way, the above-described problems caused by the inability to accurately distinguish between surmountable obstacles and dangerous distressed areas can be avoided.
在一种可能的实现方式中,如图1b和1c所示的,在执行完步骤S130之后,还可以执行步骤S140和S150。在步骤S140中,判断所述自主移动设备是否通过了所述可越障区域;若判断为自主移动设备未通过所述可越障区域,则执行步骤S150。在步骤S150中,在所述地图上将未通过的可越障区域重新标记为不可通过区域。In a possible implementation manner, as shown in FIGS. 1b and 1c, after step S130 is performed, steps S140 and S150 may also be performed. In step S140, it is judged whether the autonomous mobile device has passed the obstacle-crossable area; if it is judged that the autonomous mobile device has not passed the obstacle-crossable area, step S150 is executed. In step S150, re-mark the non-passable obstacle-passable area on the map as an impassable area.
由此,可以根据执行了越障模式的自主移动设备是否通过可越障区域,来实时更新可越障区域的当前类型,为下次运行提供更加准确的可越障区域的地图。Thus, the current type of the obstacle-surpassable area can be updated in real time according to whether the autonomous mobile device that has executed the obstacle-surpassing mode passes through the obstacle-surpassable area, and a more accurate map of the obstacle-surpassable area can be provided for the next operation.
在一种可能的实现方式中,如图1b和1c所示的,在执行完步骤S150之后,还可以执行步骤S160。在步骤S160中,自主移动设备尝试其它路径,比如执行脱困模式(比如先后退然后旋转,或重复多次地旋转并后退)从而远离该障碍物,或执行边缘跟随模式(比如先旋转使其一侧朝向该障碍物并继续运行,同时以其该侧的接近传感器非接触地检测该侧与障碍物的距离并使该距离持续保持在设定的距离范围内)从而使自主移动设备能够沿着障碍物的边缘运行。本公开不限制自主移动设备在未通过可越障区域之后的运行路径。In a possible implementation manner, as shown in FIGS. 1b and 1c, after step S150 is performed, step S160 may also be performed. In step S160, the autonomous mobile device tries other paths, such as performing an escape mode (such as back and forth and then rotating, or repeatedly rotating and backing) so as to stay away from the obstacle, or performing an edge-following mode (such as rotating first to make it a The side faces the obstacle and continues to run, and at the same time, the proximity sensor on the side detects the distance between the side and the obstacle in a non-contact manner and keeps the distance within the set distance range) so that the autonomous mobile device can move along the Run on the edge of the obstacle. The present disclosure does not limit the running path of the autonomous mobile device after not passing through the obstacle-surpassable area.
由此,针对原先标记的可越障区域(而后被重新标记为不可通过区域),在以越障模式尝试越过失败后,即可尝试其它路径,从而可以避免花费较长的不必要的越障时间。Thus, for the previously marked obstacle-passable area (and then re-marked as an impassable area), after attempting to cross the obstacle in the obstacle-passing mode fails, other paths can be tried, thereby avoiding unnecessary obstacle-crossing that takes a long time time.
步骤S130中所涉及的越障模式可以有多种方式。在一种可能的实现方式中,若自主移动设备以越障模式运行,则可依次执行图7的步骤S710、S720和S730,即,S710:自主移动设备从被卡住的当前位置后退第一距离;S720:自主移动设备对第二驱动机构制动,并且使第一驱动机构绕所述第二驱动机构向前旋转第一角度;S730:使所述第一驱动机构固定,并且使所述第二驱 动机构绕所述第一驱动机构向前旋转第二角度。其中所述第一驱动机构和所述第二驱动机构并列设置于所述自主移动设备下部。There are many ways to overcome the obstacles involved in step S130. In a possible implementation, if the autonomous mobile device operates in the obstacle-surpassing mode, steps S710, S720, and S730 in FIG. distance; S720: the autonomous mobile device brakes the second driving mechanism, and rotates the first driving mechanism forward by a first angle around the second driving mechanism; S730: fixes the first driving mechanism, and makes the The second drive mechanism is rotated forward by a second angle about the first drive mechanism. Wherein the first drive mechanism and the second drive mechanism are arranged side by side at the lower part of the autonomous mobile device.
本实施例中,如果自主移动设备在可越障区域被卡住,则自主移动设备的第一驱动机构和第二驱动机构一起后退一定距离,以从被卡住的位置后退一定距离,从而为自主移动设备的驱动机构旋转到达障碍物坡面的下边缘前提供可加速的空间;然后,对自主移动设备的一个驱动机构例如第二驱动机构制动使其静止不动或向相反方向发生少许转动,同时另一个驱动机构例如第一驱动机构以合适的速度或加速度绕该被制动的第二驱动机构旋转一个角度从而具有向前运动的位移分量,然后保持先前旋转的第一驱动机构固定不动,而原先被制动的第二驱动机构以合适的速度或加速度(第一驱动机构和第二驱动机构的速度和/或加速度可以相同或不同)绕该现在固定不动的第一驱动机构旋转一个角度从而具有向前运动的位移分量,由此,实现第一驱动机构和第二驱动机构交替向前运动。这样,借助于这两个驱动机构交替旋转运动,使得自主移动设备可能跨到可通过型障碍物上或跨过可通过型障碍物。In this embodiment, if the autonomous mobile device is stuck in the area where the obstacle can be crossed, the first drive mechanism and the second drive mechanism of the autonomous mobile device will retreat a certain distance together to retreat a certain distance from the stuck position, thereby providing The drive mechanism of the autonomous mobile device rotates to provide room for acceleration before reaching the lower edge of the obstacle slope; then, braking one drive mechanism of the autonomous mobile device, such as the second drive mechanism, makes it stand still or occurs a small amount in the opposite direction Rotate while another drive mechanism, such as the first drive mechanism, rotates an angle around the braked second drive mechanism at a suitable speed or acceleration so as to have a displacement component of forward motion, and then hold the previously rotating first drive mechanism stationary motionless, while the previously braked second drive mechanism orbits the now immobilized first drive mechanism at a suitable speed or acceleration (the speed and/or acceleration of the first drive mechanism and the second drive mechanism may be the same or different) The mechanism is rotated by an angle so as to have a displacement component of forward movement, thereby achieving alternate forward movement of the first drive mechanism and the second drive mechanism. In this way, by means of the alternating rotational movements of the two drive mechanisms, it is possible for the autonomous mobile device to step onto or over a passable obstacle.
为便于理解,以可跨越型障碍物为门槛210为例并结合图7b~7e对图7a的越障模式进行说明。For ease of understanding, the obstacle surmounting mode in FIG. 7a will be described by taking a surmountable obstacle as the threshold 210 as an example and referring to FIGS. 7b-7e.
请参阅图7b,当自主移动设备220被卡住时,执行步骤S710,自主移动设备在第一驱动机构W1和第二驱动机构W2的带动下后退第一距离,自主移动设备220与门槛210之间的相对位置关系的示意图从图7b变换成图7c。Please refer to FIG. 7b. When the autonomous mobile device 220 is stuck, step S710 is executed, and the autonomous mobile device retreats a first distance driven by the first drive mechanism W1 and the second drive mechanism W2, and the distance between the autonomous mobile device 220 and the threshold 210 The schematic diagram of the relative positional relationship between is changed from Fig. 7b to Fig. 7c.
接着,在步骤S720中,对第二驱动机构W2制动,第一驱动机构W1绕第二驱动机构W2旋转第一角度,自主移动设备220与门槛210之间的相对位置关系的示意图从图7c变换成图7d。Next, in step S720, the second drive mechanism W2 is braked, the first drive mechanism W1 rotates around the second drive mechanism W2 by a first angle, and the schematic diagram of the relative positional relationship between the autonomous mobile device 220 and the threshold 210 is shown in FIG. 7c Transformed into Figure 7d.
接着,在步骤S730中,使第一驱动机构W1固定,第二驱动机构W2绕第一驱动机构W1向前旋转第二角度,自主移动设备220与门槛210之间的相对位置关系的示意图从图7d变换成图7e,从而完成了越障。Next, in step S730, the first driving mechanism W1 is fixed, and the second driving mechanism W2 is rotated forward by a second angle around the first driving mechanism W1. 7d is transformed into Figure 7e, thereby completing the obstacle surmounting.
由此,在自主移动设备在门槛210处被卡住的情况下,通过步骤S710、S720和S730的越障模式使得两个驱动机构W1和W2交替运行,最终均能够跨过门槛210的坡面,从而解决了自主移动设备在门槛前被卡住的技术问题,在实践中是一种行之有效的越障模式。Thus, in the case that the autonomous mobile device is stuck at the threshold 210, the two driving mechanisms W1 and W2 are alternately operated through the obstacle-overriding mode of steps S710, S720 and S730, and finally both can cross the slope of the threshold 210 , so as to solve the technical problem that the autonomous mobile device is stuck before the threshold, and it is an effective obstacle-crossing mode in practice.
在一种可能的实现方式中,若自主移动设备以越障模式运行,则可依次执行图4的步骤S410和S420,即,自主移动设备从被卡住的当前位置后退第一距离,自主移动设备增大其速度以加速至第一预设速度,并以增大后的第 一预设速度(大于自主移动设备正常运行时的速度)尝试跨越可跨越型障碍物。这也包括自主移动设备将第一预设速度设置为增速的目标值,但在实际运行中自主移动设备增加速度尚未达到第一预设速度时已经冲上了可跨越型障碍物甚至已经越过了可越障区域的情况。In a possible implementation, if the autonomous mobile device operates in the obstacle-surmounting mode, steps S410 and S420 in FIG. The device increases its speed to accelerate to a first preset speed, and attempts to cross the surmountable obstacle at the increased first preset speed (greater than the speed at which the autonomous mobile device is normally operating). This also includes that the autonomous mobile device sets the first preset speed as the target value of the speed increase, but in actual operation, the autonomous mobile device has rushed over a surmountable obstacle or even crossed it before the increased speed reaches the first preset speed The situation in the obstacle-traversable area.
在一种可能的实现方式中,若自主移动设备以越障模式运行,则可依次执行图5的步骤S510、S520和S530,即,自主移动设备从被卡住的当前位置后退第一距离,自主移动设备以后退第一距离后的当前方向为初始方向,沿第一旋转方向原地旋转第一设定角度、然后自主移动设备控制其运动单元一边向前移动一边沿第二旋转方向旋转第二设定角度,重复上述过程,并在此过程中尝试跨越可越障区域;若成功跨越了可越障区域,则自主移动设备进行后续的正常运行。示例性的,自主移动设备以该越障模式运行的示意图可参阅图8a。In a possible implementation, if the autonomous mobile device operates in the obstacle-surpassing mode, steps S510, S520, and S530 in FIG. 5 may be executed in sequence, that is, the autonomous mobile device retreats a first distance from the current position where it is stuck, The autonomous mobile device takes the current direction after the first distance as the initial direction, and rotates the first set angle in situ along the first rotation direction, and then the autonomous mobile device controls its motion unit to move forward while rotating the second rotation direction for the first time. 2. Set the angle, repeat the above process, and try to cross the obstacle-crossing area during the process; if the obstacle-crossing area is successfully crossed, the autonomous mobile device will perform subsequent normal operations. For an exemplary schematic diagram of the autonomous mobile device operating in the obstacle-surpassing mode, refer to FIG. 8a.
如图8a所示,自主移动设备以自被卡住的当前位置A点后退第一距离后的当前方向为初始方向,先沿第一旋转方向(比如顺时针方向)原地旋转第一设定角度θ(比如85°),然后控制其轮组一边向前运动一边沿第二旋转方向(比如逆时针方向)旋转某个设定角度(可以称为第二设定角度,比如为175°)以到达E1点坐标位置,由于E1点坐标位置并未绕过A点坐标位置(其为可跨越型障碍物所处的位置),因此,自主移动设备再控制其轮组一边向前运动一边沿某个旋转方向(比如顺时针方向)旋转某个设定角度(比如180°)从而跨越可越障区域到达C点坐标位置,然后可以进行后续的正常运行。As shown in Figure 8a, the autonomous mobile device takes the current direction after retreating the first distance from the stuck current position A as the initial direction, and first rotates the first setting in place along the first rotation direction (for example, clockwise). Angle θ (such as 85°), and then control its wheel set to move forward while rotating a certain set angle in the second direction of rotation (such as counterclockwise) (which can be called the second set angle, such as 175°) In order to reach the coordinate position of point E1, since the coordinate position of point E1 does not go around the coordinate position of point A (which is the position of the surmountable obstacle), the autonomous mobile device then controls its wheel set to move forward and edge A certain rotation direction (such as clockwise) rotates a certain set angle (such as 180°) to reach the coordinate position of point C across the obstacle-surpassable area, and then the subsequent normal operation can be performed.
在一种可能的实现方式中,若自主移动设备以越障模式运行,则可依次执行图6的步骤S610、S620和S630,即,自主移动设备从被卡住的当前位置后退第二距离,自主移动设备以后退第二距离后的当前方向为初始方向,沿第三旋转方向原地旋转第三设定角度、然后自主移动设备控制其运动单元向前直线移动设定距离,并反复重复上述旋转、直行操作,直至跨越可越障区域,然后进行后续的正常运行。示例性的,自主移动设备以该越障模式运行的示意图可参阅图8b。In a possible implementation, if the autonomous mobile device operates in the obstacle-surpassing mode, steps S610, S620, and S630 in FIG. The autonomous mobile device takes the current direction after retreating the second distance as the initial direction, rotates the third set angle in situ along the third rotation direction, and then the autonomous mobile device controls its motion unit to move forward in a straight line for the set distance, and repeat the above steps repeatedly. Rotate and operate straight until it crosses the obstacle-surpassable area, and then perform subsequent normal operations. For an exemplary schematic diagram of the autonomous mobile device operating in this obstacle-surpassing mode, please refer to FIG. 8b.
如图8b所示,自主移动设备以自被卡住的当前位置A点后退第二距离后的当前方向为初始方向,先沿第三旋转方向(比如顺时针方向)原地旋转第三设定角度θ’(比如85°),然后控制其轮组向前直线运动设定距离以到达E1点坐标位置,由于E1点坐标位置并未绕过A点坐标位置(其为可跨越型障碍物所处的位置),因此,自主移动设备再沿某个旋转方向(比如逆时针方向)原地旋转某个设定角度(比如135°),然后控制其轮组向前直线运动某个设定距离以 到达E2点坐标位置,由于E2点坐标位置并未绕过A点坐标位置,因此自主移动设备再沿某个旋转方向(比如顺时针方向)原地旋转某个设定角度(比如60°),然后控制其轮组向前直线运动,在此过程中自主移动设备成功跨越了可越障区域到达C点,然后可以进行后续的正常运行。As shown in Figure 8b, the autonomous mobile device takes the current direction after retreating a second distance from the stuck current position A as the initial direction, and first rotates the third setting in place along the third rotation direction (for example, clockwise) Angle θ' (such as 85°), and then control its wheel set to move forward in a straight line for a set distance to reach the coordinate position of point E1. position), therefore, the autonomous mobile device then rotates in a certain direction of rotation (such as counterclockwise) at a set angle (such as 135°), and then controls its wheel set to move forward in a straight line for a certain set distance To reach the coordinate position of point E2, since the coordinate position of point E2 does not bypass the coordinate position of point A, the autonomous mobile device then rotates in a certain direction of rotation (such as clockwise) at a set angle (such as 60°) , and then control its wheel set to move forward in a straight line. During this process, the autonomous mobile device successfully crosses the obstacle-surpassing area to point C, and then can perform subsequent normal operations.
在一种可能的实现方式中,在步骤S110中还获取可越障区域中的可跨越型障碍物的参数。In a possible implementation manner, in step S110, parameters of surmountable obstacles in the obstacle-surpassable area are also acquired.
本示例性实施例中,用户除了可在地图上标记可越障区域以外,还可以设置可越障区域中的可跨越型障碍物的参数,其中该参数可以包括但不限于障碍物的形状(比如截面形状,例如梯形、矩形、圆弧形等)和/或高度。In this exemplary embodiment, in addition to marking the obstacle-surpassable area on the map, the user can also set the parameters of the surmountable obstacles in the obstacle-surpassable area, where the parameters may include but are not limited to the shape of the obstacle ( Such as cross-sectional shape (e.g. trapezoidal, rectangular, circular, etc.) and/or height.
在一种可能的实现方式中,用户可经由用户设备所显示的用于设置可跨越型障碍物的参数的画面来设置可跨越型障碍物的参数,该画面上显示有可跨越型障碍物的各种参数对应的选择按钮,用户可以通过点击相应的按钮来设置相应的障碍物参数。受篇幅所限,本公开对用户设置可跨越型障碍物的参数的方式不再展开描述。In a possible implementation manner, the user can set the parameters of the surmountable obstacle through the screen displayed on the user equipment for setting the parameters of the surmountable obstacle, and the screen displays the parameters of the surmountable obstacle. The selection buttons corresponding to various parameters, the user can set the corresponding obstacle parameters by clicking the corresponding button. Due to limited space, the present disclosure does not describe the manner in which the user sets the parameters of the surmountable obstacle.
在一种可能的实现方式中,可以根据可跨越型障碍物的参数来判断自主移动设备是否能够越过可跨越型障碍物,其中,在判断为能够越过可跨越型障碍物的情况下,执行上述步骤S130。In a possible implementation, it may be judged according to the parameters of the surmountable obstacle whether the autonomous mobile device can surmount the surmountable obstacle, wherein, if it is determined that the surmountable obstacle can be surmounted, the above-mentioned Step S130.
本示例性实施例中,自主移动设备可以根据所获取到的可跨越型障碍物的参数来判断自主移动设备是否能够越过该可跨越型障碍物。In this exemplary embodiment, the autonomous mobile device may judge whether the autonomous mobile device can cross the surmountable obstacle according to the acquired parameters of the surmountable obstacle.
若所获取到的参数(比如截面形状为梯形且高度为2.0cm的障碍物)不大于能够越过的障碍物对应的参数(参数阈值,比如截面形状为梯形且高度不大于2.7cm),则判断为自主移动设备能够越过该障碍物,自主移动设备可以执行步骤S130以越障模式运行从而尝试通过该障碍物对应的可越障区域。If the acquired parameter (such as an obstacle with a trapezoidal cross-section and a height of 2.0cm) is not greater than the parameter corresponding to the obstacle that can be crossed (parameter threshold, such as a trapezoidal cross-section and a height not greater than 2.7cm), then judge In order for the autonomous mobile device to be able to overcome the obstacle, the autonomous mobile device may perform step S130 to operate in the obstacle-surpassing mode to try to pass through the obstacle-surmountable area corresponding to the obstacle.
反之,若所获取到的参数大于能够越过的障碍物对应的参数,则判断为自主移动设备不能够越过该障碍物,自主移动设备尝试越障可能是不必要的处理,因此可以命令自主移动设备执行脱困模式、边缘跟随模式等避障处理,以提高工作效率。Conversely, if the acquired parameter is greater than the parameter corresponding to the obstacle that can be crossed, it is judged that the autonomous mobile device cannot cross the obstacle, and it may be unnecessary for the autonomous mobile device to attempt to cross the obstacle, so the autonomous mobile device can be ordered Perform obstacle avoidance processing such as escape mode and edge following mode to improve work efficiency.
在一种可能的实现方式中,所述可跨越型障碍物的参数与所述越障模式有对应关系,当所述自主移动设备在所述可越障区域被卡住时,根据所述可跨越型障碍物的参数和所述对应关系执行对应的越障模式。In a possible implementation manner, the parameter of the surmountable obstacle has a corresponding relationship with the obstacle surmounting mode, and when the autonomous mobile device is stuck in the obstacle surmountable area, according to the surmountable The parameters of the leap-over obstacle and the corresponding relationship implement the corresponding obstacle-crossing mode.
本示例性实施例中,可以根据可跨越型障碍物的参数选择与该参数对应的越障模式,并执行所选择的越障模式。换言之,可针对不同的可跨越型障碍物的参数来设置不同的越障模式。In this exemplary embodiment, the obstacle-crossing mode corresponding to the parameter can be selected according to the parameter of the surmountable obstacle, and the selected obstacle-breaking mode can be executed. In other words, different obstacle clearance modes can be set according to the parameters of different surmountable obstacles.
假设可跨越型障碍物的参数阈值包括障碍物的截面形状为梯形且高度为第一阈值2.7cm、障碍物的截面形状为矩形且高度为第二阈值2cm、以及障碍物的截面形状为圆弧形且高度为第三阈值2.2cm,如果用户经由用户设备设置了高度高于第一阈值的障碍物参数,则根据用户所设置的可跨越型障碍物的参数和前述障碍物参数阈值可以确定出该障碍物是不能够越过的,因此,当自主移动设备运行到该可越障区域时将不尝试跨越该障碍物,例如可以执行脱困模式、边缘跟随模式等避障处理,并且自主移动设备可自动地在地图中将该区域标记为不可通过区域。Assume that the parameter thresholds of the surmountable obstacles include the cross-sectional shape of the obstacle as a trapezoid and the height of the first threshold of 2.7cm, the cross-sectional shape of the obstacle as a rectangle and the height of the second threshold of 2cm, and the cross-sectional shape of the obstacle as an arc and the height is the third threshold of 2.2cm, if the user sets the obstacle parameter with a height higher than the first threshold via the user equipment, then it can be determined according to the parameter of the surmountable obstacle set by the user and the aforementioned obstacle parameter threshold The obstacle cannot be crossed. Therefore, when the autonomous mobile device runs into the obstacle-surpassable area, it will not try to cross the obstacle. For example, it can perform obstacle avoidance processing such as escape mode and edge following mode, and the autonomous mobile device can Automatically marks the area on the map as impassable.
继续上述示例,如果用户经由用户设备设置了高度低于第一阈值且截面形状为梯形的障碍物参数,则自主移动设备根据用户所设置的障碍物参数和前述障碍物参数阈值可以确定出该障碍物是能够越过的,若自主移动设备在可越障区域中被卡住,则以越障模式运行,示例性的,自主移动设备沿着正向行进方向与可越障区域所对应的可跨越型障碍物的坡面下边缘成预设角度的方向运行,以越过该可跨越型障碍物。亦即,自主移动设备沿着图3d所示的斜向越障路径运行。Continuing the above example, if the user sets the obstacle parameter with a height lower than the first threshold and a trapezoidal cross-sectional shape via the user equipment, the autonomous mobile device can determine the obstacle according to the obstacle parameter set by the user and the aforementioned obstacle parameter threshold Objects can be surmounted. If the autonomous mobile device is stuck in the obstacle surmountable area, it will run in the obstacle surmountable mode. Exemplarily, the autonomous mobile device will follow the forward direction and the surmountable obstacle corresponding to the obstacle surmountable area. The lower edge of the slope of the type obstacle runs in the direction of a preset angle to cross the surmountable obstacle. That is, the autonomous mobile device runs along the oblique obstacle-crossing path shown in Figure 3d.
继续上述示例,如果用户经由用户设备设置了高度低于第二阈值且截面形状为矩形的障碍物参数,则自主移动设备根据用户所设置的障碍物参数和前述障碍物参数阈值可以确定出该障碍物是能够越过的,若自主移动设备在可越障区域中被卡住,则以越障模式运行,示例性的,自主移动设备后退一段距离,对一个轮子制动并使另一个轮子绕被制动的轮子旋转一定角度以使旋转的轮子跨到或跨过障碍物,保持先前旋转的轮子固定不动,而先前被制动的一个轮子绕被固定的轮子旋转一定角度以使旋转的轮子跨到或跨过障碍物,亦即,自主移动设备以图7所示的越障模式流程图运行。Continuing the above example, if the user sets the obstacle parameter with a height lower than the second threshold and a rectangular cross-sectional shape via the user equipment, the autonomous mobile device can determine the obstacle according to the obstacle parameter set by the user and the aforementioned obstacle parameter threshold Objects can be surmounted. If the autonomous mobile device is stuck in the obstacle-surpassable area, it operates in obstacle-surpassing mode. For example, the autonomous mobile device moves back a certain distance, brakes one wheel and makes the other wheel go around the obstacle. The braked wheel is rotated at an angle to allow the rotating wheel to step over or over an obstacle, keeping the previously rotating wheel stationary, while the previously braked wheel is rotated at an angle around the fixed wheel to allow the rotating wheel Stepping to or over an obstacle, that is, the autonomous mobile device operates with the flow chart of the obstacle surmounting mode shown in FIG. 7 .
继续上述示例,如果用户经由用户设备设置了高度低于第三阈值且障碍物的截面形状为圆弧形的障碍物参数,则自主移动设备根据用户所设置的障碍物参数和前述障碍物参数阈值可以确定出该障碍物是能够越过的,若自主移动设备在可越障区域中被卡住,则以特定越障模式运行,示例性的,自主移动设备后退一段距离,增大其速度并以增大后的速度越过障碍物,亦即,自主移动设备以图4所示的越障模式运行。Continuing with the above example, if the user sets an obstacle parameter whose height is lower than the third threshold and the cross-sectional shape of the obstacle is a circular arc via the user equipment, the autonomous mobile device will It can be determined that the obstacle is surmountable. If the autonomous mobile device is stuck in the obstacle-surpassable area, it operates in a specific obstacle-surpassing mode. For example, the autonomous mobile device retreats a certain distance, increases its speed and uses The increased speed traverses the obstacle, ie the autonomous mobile device operates in the obstacle clearance mode shown in FIG. 4 .
根据本示例性实施例的控制方法,根据所获取到的障碍物参数确定是否能够越过障碍物,在确定为能够越过障碍物时,根据所获取到的标记有可越障区域的地图来规划在该可越障区域上设置有越障路径的预定路径并按照该预定路径运行,由此,用户辅助在地图上标记障碍物和设置障碍物参数, 并在基于障碍物参数确定为能够跨越障碍物的情况下才基于进行了标记处理的地图来规划适合于所标记的障碍物的路径,这样,可避免自主移动设备在进行无谓尝试跨越障碍物过程中可能遇到的被困的风险,并减少自主移动设备在进行不必要的越障处理时消耗的时间,从而可以保证设备运行稳定性并提高工作效率。另外,当自主移动设备在可越障区域被卡住时,自主移动设备以越过障碍物的可能性更高的越障模式来运行,由此,可提高自主移动设备越过障碍物的概率。According to the control method of this exemplary embodiment, it is determined whether the obstacle can be crossed according to the obtained obstacle parameters. The obstacle-crossable area is set with a predetermined path of the obstacle-crossing path and runs according to the predetermined path. Thus, the user assists in marking obstacles on the map and setting obstacle parameters, and determines that obstacles can be crossed based on the obstacle parameters. In the case of marking, the path suitable for the marked obstacles is planned based on the marked map. In this way, the risk of being trapped that the autonomous mobile device may encounter during unnecessary attempts to cross obstacles can be avoided, and the The time consumed by autonomous mobile equipment in unnecessary obstacle-crossing processing can ensure the stability of equipment operation and improve work efficiency. In addition, when the autonomous mobile device is stuck in the obstacle-surpassable area, the autonomous mobile device operates in an obstacle-surpassing mode with a higher probability of overcoming obstacles, thereby increasing the probability of the autonomous mobile device overcoming obstacles.
在一种可能的实现方式中,如图1b和1c所述的,在步骤S130之后,还执行以下步骤:In a possible implementation, as described in Figures 1b and 1c, after step S130, the following steps are also performed:
在步骤S140中,判断自主移动设备是否通过了可越障区域。In step S140, it is judged whether the autonomous mobile device has passed the obstacle-surpassable area.
本实施例中,存在由于诸如障碍物过高而导致自主移动设备难以穿越可越障区域的情况,在该情况下,自主移动设备即使以越障模式运行来尝试通过可越障区域,可能仍没有成功通过可越障区域,若继续尝试通过可越障区域,则将影响自主移动设备正常的工作效率。In this embodiment, there are situations where it is difficult for the autonomous mobile device to pass through the obstacle-surpassable area due to obstacles such as being too high. If you fail to pass through the obstacle surmountable area, if you continue to try to pass through the obstacle surmountable area, it will affect the normal working efficiency of the autonomous mobile device.
为此,在执行完成图1a所示的控制方法的所有步骤之后,如图1b和1c所述的,还判断自主移动设备是否通过了可越障区域,比如可以通过判断自主移动设备是否在可越障区域中被卡住来判断自主移动设备是否通过了可越障区域,若判断为自主移动设备在可越障区域中被卡住,则判断为自主移动设备未通过可越障区域;反之,若判断为自主移动设备在可越障区域中没有被卡住,则判断为自主移动设备通过了可越障区域。其中,判断自主移动设备是否被卡住的方式可以参阅前文描述,受篇幅所限,此处不再展开赘述。To this end, after executing all the steps of the control method shown in Figure 1a, as described in Figures 1b and 1c, it is also judged whether the autonomous mobile device has passed the obstacle-crossable area, for example, by judging whether the autonomous mobile device is in the If it is stuck in the obstacle-crossing area, it is judged whether the autonomous mobile device has passed the obstacle-crossable area. If it is judged that the autonomous mobile device is stuck in the obstacle-crossable area, it is judged that the autonomous mobile device has not passed the obstacle-crossable area; , if it is determined that the autonomous mobile device is not stuck in the obstacle-surpassable area, it is determined that the autonomous mobile device has passed the obstacle-surmountable area. Among them, the method of judging whether the autonomous mobile device is stuck can refer to the previous description, and due to space limitation, details will not be repeated here.
在一种实现方式中,若在步骤S140中判断为“否”,则即使自主移动设备以越障模式运行也未通过可越障区域,此时,可在地图上将未通过的可越障区域重新标记为不可通过区域。In one implementation, if the determination is "No" in step S140, the autonomous mobile device has not passed the obstacle-surpassable area even if it is running in the obstacle-surpassing mode. The area is re-marked as an impassable area.
本实施例中,在自主移动设备以越障模式运行来尝试越障并以失败告终时,为提高工作效率,自主移动设备可尝试其它路径,比如执行脱困模式、边缘跟随模式等。In this embodiment, when the autonomous mobile device operates in the obstacle surmounting mode to try to overcome the obstacle and fails, in order to improve work efficiency, the autonomous mobile device can try other paths, such as executing the escape mode, edge following mode, etc.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备沿着所述自主移动设备的正向行进方向与所述可越障区域对应的可跨越型障碍物的坡面下边缘成预设角度的方向运行,以越过可跨越型障碍物。其中,预设角度例如可以包括但不限于[10°,45°]区间内的任意角度。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device follow the forward travel direction of the autonomous mobile device along the slope of the surmountable obstacle corresponding to the obstacle surmountable area The lower edge of the face runs in a direction at a preset angle to cross over a surmountable obstacle. Wherein, the preset angle may include, but not limited to, any angle within the interval [10°, 45°], for example.
本实施例中,自主移动设备可采用A-Star(也写作A*)算法来规划路径。其中,所属技术领域的技术人员能够知晓,A*算法是一种静态路网中求解最 短路径最有效的直接搜索方法,其公式表示为:f(n)=g(n)+h(n),其中,f(n)是从初始状态经由状态n到目标状态的代价估计,g(n)是在状态空间中从初始状态到状态n的实际代价,h(n)是从状态n到目标状态的最佳路径的估计代价。(对于路径搜索问题,状态就是图中的节点,代价就是距离)。受篇幅缩限,关于A*算法的原理在本公开中不再赘述。In this embodiment, the autonomous mobile device can use the A-Star (also written as A*) algorithm to plan the path. Wherein, those skilled in the art can know that the A* algorithm is the most effective direct search method for solving the shortest path in a static road network, and its formula is expressed as: f(n)=g(n)+h(n) , where f(n) is the cost estimate from the initial state to the goal state via state n, g(n) is the actual cost from the initial state to state n in the state space, h(n) is the cost from state n to the goal The estimated cost of the best path to the state. (For the path search problem, the state is the node in the graph, and the cost is the distance). Due to the limited space, the principle of the A* algorithm will not be repeated in this disclosure.
在自主移动设备采用A*算法规划路径时,如果搜索的点位于可越障区域(比如门槛区域)内,则将斜向的搜索方式代价设置为比横竖方向的搜索方式代价更低,从而让自主移动设备所规划的路径更倾向于斜向穿过可越障区域,亦即,将所规划的路径由横竖越障路径修改为斜向越障路径。When the autonomous mobile device uses the A* algorithm to plan the path, if the search point is located in the obstacle-surpassing area (such as the threshold area), the cost of the oblique search method is set to be lower than the cost of the horizontal and vertical search methods, so that The path planned by the autonomous mobile device tends to pass through the obstacle-surpassing area obliquely, that is, the planned path is modified from a horizontal and vertical obstacle-crossing path to an oblique obstacle-crossing path.
为便于理解“路径规划”,以下以3a~3d为例进行说明。结合图3a~3d可知,自主移动设备在栅格地图进行路径规划时,对于位于可越障区域240外的点,采用横竖方向的搜索方式;对于位于可越障区域240内的点,将横竖方向的搜索方式调整为采用代价比横竖方向的搜索方式的代价更低的斜向的搜索方式,由此,所规划出的路径为图3d所示的路径。相较于图3c所示的未调整位于可越障区域240内的点的搜索方式而规划的路径而言,图3d所示的调整了位于可越障区域240内的点的搜索方式而规划的路径,其在可越障区域240内的路径更倾向于沿45度的方向穿过可越障区域240。换言之,结合图3e可知,若自主移动设备按照图3d的路径运行,则自主移动设备的正向行进方向与障碍物230(的坡面下边缘)的夹角为45°。In order to facilitate the understanding of "path planning", 3a-3d are taken as examples for description below. Combining with Figures 3a-3d, it can be seen that when the autonomous mobile device performs path planning on the grid map, for the points located outside the obstacle surmountable area 240, the horizontal and vertical direction search methods are used; The directional search method is adjusted to use an oblique search method with a lower cost than the horizontal and vertical search methods, and thus the planned path is the path shown in Figure 3d. Compared with the route planned without adjusting the search method of the points located in the obstacle surmountable area 240 shown in FIG. 3c , the route shown in FIG. , the path in the obstacle-surpassable area 240 tends to pass through the obstacle-surpassable area 240 along a direction of 45 degrees. In other words, referring to FIG. 3e, it can be seen that if the autonomous mobile device runs along the path shown in FIG. 3d, the angle between the forward direction of the autonomous mobile device and the obstacle 230 (the lower edge of the slope) is 45°.
应能够理解,当自主移动设备以上述斜向越障路径尝试越过可越障区域失败时,可继续以另一斜向越障路径(其对应的预定角度不同于前一斜向越障路径)再次尝试越过可越障区域。换言之,若自主移动设备沿着正向行进方向与可越障区域对应的可跨越型障碍物的坡面下边缘成一个预设角度的方向运行来进行越障处理而失败时,可以更改预设角度并以自主移动设备的正向行进方向与可越障区域对应的可跨越型障碍物的坡面下边缘成更改后的预设角度的方向运行来再次进行越障处理。It should be understood that when the autonomous mobile device fails to cross the obstacle-surpassable area with the above-mentioned oblique obstacle-surpassing path, it can continue to use another oblique obstacle-surpassing path (the corresponding predetermined angle is different from the previous oblique obstacle-surpassing path) Try again to cross the accessible area. In other words, if the autonomous mobile device runs along a direction in which the forward travel direction forms a preset angle with the lower edge of the slope of the surmountable obstacle corresponding to the obstacle-surpassable area to perform obstacle-surpassing processing and fails, the preset can be changed. The forward travel direction of the autonomous mobile device and the lower edge of the slope of the surmountable obstacle corresponding to the obstacle-surpassing area form a changed preset angle to perform obstacle-surpassing processing again.
在一种可能的实现方式中,自主移动设备可规划的预定路径所对应的模式可包括现有技术中的诸如弓字型覆盖模式、沿边模式、导航模式、脱困模式等的特殊模式。受篇幅所限,本公开对此不再展开描述。In a possible implementation manner, the mode corresponding to the predetermined path that the autonomous mobile device can plan may include special modes in the prior art such as a bow-shaped coverage mode, an edge mode, a navigation mode, and an escape mode. Due to space limitation, this disclosure will not describe it any further.
图9示出根据示例性实施例的自主移动设备的控制装置的框图。请参阅图9,该自主移动设备的控制装置1100可以包括获取单元1110、判断单元1120和处理单元1130。获取单元1110用于获取标记有可越障区域的地图。判断单元1120用于判断自主移动设备是否在可越障区域被卡住。处理单元1130与判 断单元1120连接,用于在判断为所述自主移动设备在所述可越障区域被卡住的情况下,命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。Fig. 9 shows a block diagram of a control device of an autonomous mobile device according to an exemplary embodiment. Referring to FIG. 9 , the control apparatus 1100 of the autonomous mobile device may include an acquiring unit 1110 , a judging unit 1120 and a processing unit 1130 . The obtaining unit 1110 is used to obtain a map marked with obstacle-surpassable areas. The judging unit 1120 is used to judge whether the autonomous mobile device is stuck in the obstacle-surpassable area. The processing unit 1130 is connected to the judging unit 1120, and is configured to command the autonomous mobile device to execute an obstacle-crossing mode in order to try to pass the obstacle-crossable area when it is judged that the autonomous mobile device is stuck in the obstacle-crossable area. Obstacle clearance area.
在一种可能的实现方式中,判断单元1120被配置为:判断所述自主移动设备是否运行至所述可越障区域;在判断为所述自主移动设备运行至所述可越障区域的情况下,继续判断所述自主移动设备是否在所述可越障区域被卡住,其中,在判断为所述自主移动设备在所述可越障区域被卡住的情况下,处理单元1130命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。In a possible implementation manner, the judging unit 1120 is configured to: judge whether the autonomous mobile device runs to the obstacle-crossable area; Next, continue to judge whether the autonomous mobile device is stuck in the obstacle-passable area, wherein, if it is determined that the autonomous mobile device is stuck in the obstacle-passable area, the processing unit 1130 instructs the The autonomous mobile device executes an obstacle surmounting mode to try to pass through the obstacle surmountable area.
在一种可能的实现方式中,判断单元1120被配置为:判断所述自主移动设备是否被卡住;在判断为所述自主移动设备被卡住的情况下,继续判断所述自主移动设备被卡住的位置是否在所述可越障区域内,其中,在判断为所述自主移动设备被卡住的位置在所述可越障区域内的情况下,处理单元1130命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。In a possible implementation manner, the judging unit 1120 is configured to: judge whether the autonomous mobile device is stuck; if it is judged that the autonomous mobile device is stuck, continue to judge that the autonomous mobile device is stuck Whether the stuck position is within the obstacle-surmountable area, wherein, if it is determined that the autonomous mobile device is stuck within the obstacle-surpassable area, the processing unit 1130 instructs the autonomous mobile device to Executing an obstacle clearance mode to attempt to pass through the obstacle clearance area.
在一种可能的实现方式中,判断单元1120还判断所述自主移动设备是否通过了所述可越障区域;在判断为所述自主移动设备未通过所述可越障区域的情况下,在所述地图上将未通过的可越障区域重新标记为不可通过区域。In a possible implementation manner, the judging unit 1120 also judges whether the autonomous mobile device has passed the obstacle-crossable area; if it is judged that the autonomous mobile device has not passed the obstacle-crossable area, Obstacle traversable areas that have not been passed are remarked as impassable areas on the map.
在一种可能的实现方式中,在判断为所述自主移动设备被卡住的位置不在所述可越障区域内的情况下,处理单元1130命令所述自主移动设备执行脱困模式、报警、和/或在地图上将所述被卡住的位置标记为普通障碍物或将所述被卡住的位置所在的区域标记为不可通过区域。In a possible implementation manner, when it is determined that the location where the autonomous mobile device is stuck is not within the obstacle-surpassable area, the processing unit 1130 commands the autonomous mobile device to execute the escape mode, alarm, and /or mark the stuck position on the map as a common obstacle or mark the area where the stuck position is located as an impassable area.
在一种可能的实现方式中,处理单元1130命令所述自主移动设备在未建立地图的工作空间运行并且建立所述工作空间的地图;判断单元1120判断所述自主移动设备是否被卡住;在判断为所述自主移动设备在当前位置被卡住的情况下,处理单元1130命令所述自主移动设备执行越障模式;在所述自主移动设备执行越障模式之后,判断单元1120判断所述自主移动设备是否通过了与所述自主移动设备被卡住的位置相对应的区域;在判断为所述自主移动设备通过了与所述自主移动设备被卡住的位置相对应的区域的情况下,在所创建的地图上将该区域标记为可越障区域;和/或在判断为所述自主移动设备未通过与所述自主移动设备被卡住的位置相对应的区域的情况下,在所创建的地图上将该区域标记为不可通过区域。In a possible implementation, the processing unit 1130 commands the autonomous mobile device to run in a workspace without a map and establishes a map of the workspace; the judging unit 1120 judges whether the autonomous mobile device is stuck; If it is judged that the autonomous mobile device is stuck at the current position, the processing unit 1130 commands the autonomous mobile device to execute the obstacle-crossing mode; after the autonomous mobile device executes the obstacle-crossing mode, the judging unit 1120 judges that the autonomous mobile device Whether the mobile device has passed the area corresponding to the position where the autonomous mobile device is stuck; if it is determined that the autonomous mobile device has passed the area corresponding to the position where the autonomous mobile device is stuck, marking the area on the created map as an obstacle traversable area; and/or in the event that the autonomous mobile device is determined not to have passed through the area corresponding to the location where the autonomous mobile device is stuck, The created map marks the area as impassable.
在一种可能的实现方式中,获取单元1110还获取可越障区域中的可跨越型障碍物的参数。In a possible implementation manner, the acquiring unit 1110 also acquires parameters of surmountable obstacles in the obstacle-surpassable area.
在一种可能的实现方式中,获取单元1110被配置为:将工作空间的地图推送给用户;接收用户标记了可越障区域的地图。In a possible implementation manner, the obtaining unit 1110 is configured to: push the map of the workspace to the user; and receive the map on which the user has marked the obstacle-surpassable area.
在一种可能的实现方式中,还包括:推荐单元(未示出),用于在将工作空间的地图推送给用户后,向用户推荐用以在可越障区域内标记可跨越型障碍物的预定形状。In a possible implementation, it also includes: a recommendation unit (not shown), configured to recommend to the user to mark the surmountable obstacle in the obstacle-surpassable area after the map of the workspace is pushed to the user predetermined shape.
在一种可能的实现方式中,判断单元1120还根据所述可跨越型障碍物的参数来判断所述自主移动设备是否能够越过所述可跨越型障碍物,其中,在判断为能够越过所述可跨越型障碍物的情况下,处理单元1130命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域。In a possible implementation manner, the judging unit 1120 also judges whether the autonomous mobile device can surmount the surmountable obstacle according to the parameters of the surmountable obstacle, wherein, after judging that the surmountable obstacle can be In the case of a surmountable obstacle, the processing unit 1130 instructs the autonomous mobile device to execute an obstacle surmounting mode, so as to try to pass through the obstacle surmountable area.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备沿着正向行进方向与可越障区域所对应的可跨越型障碍物的坡面下边缘成预设角度的方向运行,以越过所述可跨越型障碍物。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device form a preset angle with the lower edge of the slope of the surmountable obstacle corresponding to the obstacle surmountable area along the forward traveling direction run in the direction to cross the surmountable obstacle.
在一种可能的实现方式中,所述预设角度不小于10°且不大于45°。In a possible implementation manner, the preset angle is not less than 10° and not greater than 45°.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备从当前位置后退第一距离;对第二驱动机构制动,并且使第一驱动机构绕所述第二驱动机构向前旋转第一角度,其中所述第一驱动机构和所述第二驱动机构并列设置于所述自主移动设备;使所述第一驱动机构固定,并且使所述第二驱动机构绕所述第一驱动机构向前旋转第二角度。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from the current position; braking the second driving mechanism, and making the first driving mechanism rotate around the second driving mechanism; The mechanism is rotated forward by a first angle, wherein the first drive mechanism and the second drive mechanism are arranged side by side on the autonomous mobile device; the first drive mechanism is fixed, and the second drive mechanism is rotated around the The first driving mechanism rotates forward by a second angle.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备从被卡住的当前位置后退第一距离;使所述自主移动设备加速至第一预设速度,并以所述第一预设速度跨越所述可跨越型障碍物,其中所述第一预设速度大于所述自主移动设备正常运行时的速度。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from the stuck current position; accelerating the autonomous mobile device to a first preset speed, and The first preset speed crosses the surmountable obstacle, wherein the first preset speed is greater than the speed of the autonomous mobile device during normal operation.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备从被卡住的当前位置后退第一距离;使所述自主移动设备以后退所述第一距离后的当前方向为初始方向,沿第一旋转方向原地旋转第一设定角度、然后控制所述自主移动设备的运动单元一边向前移动一边沿第二旋转方向旋转第二设定角度,其中所述第二旋转方向与所述第一旋转方向相反。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device retreat a first distance from a stuck current position; The direction is the initial direction, rotate the first set angle in situ along the first rotation direction, and then control the motion unit of the autonomous mobile device to move forward while rotating the second set angle along the second rotation direction, wherein the first The second direction of rotation is opposite to the first direction of rotation.
在一种可能的实现方式中,所述越障模式包括:使所述自主移动设备从被卡住的当前位置后退第二距离;使所述自主移动设备以后退所述第二距离后的当前方向为初始方向,沿第三旋转方向原地旋转第三设定角度、然后控制所述自主移动设备的运动单元向前直线移动设定距离。In a possible implementation manner, the obstacle surmounting mode includes: making the autonomous mobile device retreat a second distance from a stuck current position; The direction is the initial direction, rotate in situ at a third set angle along the third rotation direction, and then control the motion unit of the autonomous mobile device to move forward a set distance in a straight line.
在一种可能的实现方式中,所述可跨越型障碍物的参数与所述越障模式有对应关系,当所述自主移动设备在所述可越障区域被卡住时,处理单元 1130根据所述可跨越型障碍物的参数和所述对应关系执行对应的越障模式。In a possible implementation, the parameter of the surmountable obstacle corresponds to the obstacle surmounting mode, and when the autonomous mobile device is stuck in the obstacle surmountable area, the processing unit 1130 The parameters of the surmountable obstacle and the corresponding relationship execute a corresponding obstacle-crossing mode.
在一种可能的实现方式中,所述可跨越型障碍物的参数包括形状和/或高度。In a possible implementation manner, the parameters of the surmountable obstacle include shape and/or height.
图10示出根据示例性实施例的自主移动设备的框图。请参阅图10,该自主移动设备1200可以包括自主移动设备的控制装置1100和运动单元1210。运动单元1210与控制装置1100连接,用于响应于所述控制装置1100命令所述自主移动设备1200执行越障模式,以所述越障模式运动以尝试通过所述可越障区域。运动单元1210例如可以包括但不限于轮组。Figure 10 shows a block diagram of an autonomous mobile device, according to an exemplary embodiment. Referring to FIG. 10 , the autonomous mobile device 1200 may include a control device 1100 and a motion unit 1210 of the autonomous mobile device. The movement unit 1210 is connected with the control device 1100, and is used for responding to the control device 1100 commanding the autonomous mobile device 1200 to execute an obstacle-crossing mode, and to try to pass through the obstacle-crossing area by moving in the obstacle-crossing mode. The exercise unit 1210 may include, but is not limited to, a wheel set, for example.
关于上述实施例中的装置,其中各个单元执行操作的具体方式已经在有关该方法的实施例中进行了详细描述,此处将不做详细阐述说明。Regarding the apparatus in the above embodiments, the specific manner in which each unit performs operations has been described in detail in the embodiments related to the method, and will not be described in detail here.
以上已经描述了本公开的各实施例,上述说明是示例性的,并非穷尽性的,并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场中的技术的技术改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。Having described various embodiments of the present disclosure above, the foregoing description is exemplary, not exhaustive, and is not limited to the disclosed embodiments. Many modifications and alterations will be apparent to those of ordinary skill in the art without departing from the scope and spirit of the described embodiments. The terminology used herein is chosen to best explain the principles of the various embodiments, practical applications or technical improvements over technologies in the market, or to enable other persons of ordinary skill in the art to understand the various embodiments disclosed herein.

Claims (21)

  1. 一种自主移动设备的控制方法,其特征在于,包括:A method for controlling an autonomous mobile device, comprising:
    获取步骤,用于获取标记有可越障区域的地图;The obtaining step is used to obtain the map marked with the obstacle traversable area;
    判断步骤,用于判断所述自主移动设备是否在所述可越障区域被卡住;A judging step, for judging whether the autonomous mobile device is stuck in the obstacle-crossable area;
    处理步骤,用于在判断为所述自主移动设备在所述可越障区域被卡住的情况下,命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域;A processing step for ordering the autonomous mobile device to execute an obstacle-passing mode in order to try to pass through the obstacle-passable area when it is determined that the autonomous mobile device is stuck in the obstacle-passable area;
    所述控制方法还包括,在所述处理步骤之后:The control method also includes, after the processing step:
    判断所述自主移动设备是否通过了所述可越障区域;judging whether the autonomous mobile device has passed the obstacle-surpassable area;
    在判断为所述自主移动设备未通过所述可越障区域的情况下,在所述地图上将未通过的可越障区域重新标记为不可通过区域。If it is determined that the autonomous mobile device has not passed the obstacle-passable area, re-marking the failed obstacle-passable area as an impassable area on the map.
  2. 根据权利要求1所述的控制方法,其特征在于,所述判断步骤包括:The control method according to claim 1, wherein the judging step comprises:
    判断所述自主移动设备是否运行至所述可越障区域;judging whether the autonomous mobile device runs to the obstacle-surpassable area;
    在判断为所述自主移动设备运行至所述可越障区域的情况下,继续判断所述自主移动设备是否在所述可越障区域被卡住,If it is determined that the autonomous mobile device is running to the obstacle-surpassable area, continue to determine whether the autonomous mobile device is stuck in the obstacle-surmountable area,
    其中,在判断为所述自主移动设备在所述可越障区域被卡住的情况下,执行所述处理步骤。Wherein, when it is determined that the autonomous mobile device is stuck in the obstacle-surpassable area, the processing steps are executed.
  3. 根据权利要求1所述的控制方法,其特征在于,所述判断步骤包括:The control method according to claim 1, wherein the judging step comprises:
    判断所述自主移动设备是否被卡住;determining whether the autonomous mobile device is stuck;
    在判断为所述自主移动设备被卡住的情况下,继续判断所述自主移动设备被卡住的位置是否在所述可越障区域内,If it is determined that the autonomous mobile device is stuck, continue to determine whether the stuck position of the autonomous mobile device is within the obstacle-surpassable area,
    其中,在判断为所述自主移动设备被卡住的位置在所述可越障区域内的情况下,执行所述处理步骤。Wherein, in a case where it is determined that the position where the autonomous mobile device is stuck is within the obstacle-surpassable area, the processing steps are executed.
  4. 根据权利要求3所述的控制方法,其特征在于,The control method according to claim 3, characterized in that,
    在判断为所述自主移动设备被卡住的位置不在所述可越障区域内的情况下,命令所述自主移动设备执行脱困模式、报警、和/或在地图上将所述被卡住的位置标记为普通障碍物或将所述被卡住的位置所在的区域标记为不可通过区域。If it is determined that the position where the autonomous mobile device is stuck is not within the obstacle-surpassable area, order the autonomous mobile device to perform an escape mode, alarm, and/or place the stuck position on the map Mark the location as a normal obstacle or mark the area where the stuck location is located as an impassable area.
  5. 根据权利要求1-3中任一项所述的控制方法,其特征在于,还包括建 图步骤:According to the control method described in any one of claims 1-3, it is characterized in that, also comprising the step of building a map:
    命令所述自主移动设备在未建立地图的工作空间运行并且建立所述工作空间的地图;commanding the autonomous mobile device to operate in an unmapped workspace and map the workspace;
    在自主移动设备的运行过程中判断所述自主移动设备是否被卡住;determining whether the autonomous mobile device is stuck during operation of the autonomous mobile device;
    在判断为所述自主移动设备在当前位置被卡住的情况下,命令所述自主移动设备执行越障模式;If it is determined that the autonomous mobile device is stuck at the current location, ordering the autonomous mobile device to execute an obstacle surmounting mode;
    在所述自主移动设备执行越障模式之后,判断所述自主移动设备是否通过了与所述自主移动设备被卡住的位置相对应的区域;After the autonomous mobile device executes the obstacle-crossing mode, judging whether the autonomous mobile device has passed an area corresponding to the position where the autonomous mobile device is stuck;
    在判断为所述自主移动设备通过了与所述自主移动设备被卡住的位置相对应的区域的情况下,在所创建的地图上将该区域标记为可越障区域;和/或If it is determined that the autonomous mobile device has passed through an area corresponding to the location where the autonomous mobile device is stuck, marking the area as an obstacle traversable area on the created map; and/or
    在判断为所述自主移动设备未通过与所述自主移动设备被卡住的位置相对应的区域的情况下,在所创建的地图上将该区域标记为不可通过区域。If it is determined that the autonomous mobile device has not passed through the area corresponding to the location where the autonomous mobile device is stuck, marking the area as an impassable area on the created map.
  6. 根据权利要求1-3中任一项所述的控制方法,其特征在于,在所述获取步骤中还获取可越障区域中的可跨越型障碍物的参数。The control method according to any one of claims 1-3, characterized in that, in the acquiring step, parameters of surmountable obstacles in the obstacle-surpassable area are also acquired.
  7. 根据权利要求1-6中任一项所述的控制方法,其特征在于,所述获取步骤包括:The control method according to any one of claims 1-6, wherein the acquiring step comprises:
    将工作空间的地图推送给用户;Push the map of the workspace to the user;
    接收用户标记了可越障区域的地图。Receives a map where the user has marked obstacle-traversable areas.
  8. 根据权利要求7所述的控制方法,其特征在于,还包括:The control method according to claim 7, further comprising:
    在将工作空间的地图推送给用户后,向用户推荐用以在可越障区域内标记可跨越型障碍物的预定形状;After the map of the workspace is pushed to the user, recommend to the user a predetermined shape for marking a surmountable obstacle in the obstacle-surpassable area;
    接收用户使用所述预定形状标记了可越障区域的地图。A map in which the user has marked the obstacle-surpassable area using the predetermined shape is received.
  9. 根据权利要求6所述的控制方法,其特征在于,还包括:The control method according to claim 6, further comprising:
    根据所述可跨越型障碍物的参数来判断所述自主移动设备是否能够越过所述可跨越型障碍物,judging whether the autonomous mobile device can cross the surmountable obstacle according to parameters of the surmountable obstacle,
    其中,在判断为能够越过所述可跨越型障碍物的情况下,执行所述处理 步骤。Wherein, when it is determined that the surmountable obstacle can be crossed, the processing step is executed.
  10. 根据权利要求1-9中任一项所述的控制方法,其特征在于,所述越障模式包括:使所述自主移动设备沿着正向行进方向与可越障区域所对应的可跨越型障碍物的坡面下边缘成预设角度的方向运行,以越过所述可跨越型障碍物。The control method according to any one of claims 1-9, characterized in that the obstacle surmounting mode includes: making the autonomous mobile device follow the forward travel direction and the surmountable type corresponding to the obstacle surmountable area. The lower edge of the slope of the obstacle runs in a direction at a predetermined angle to overcome the surmountable obstacle.
  11. 根据权利要求10所述的控制方法,其特征在于,所述预设角度不小于10°且不大于45°。The control method according to claim 10, wherein the preset angle is not less than 10° and not greater than 45°.
  12. 根据权利要求1-9中任一项所述的控制方法,其特征在于,所述越障模式包括:The control method according to any one of claims 1-9, characterized in that the obstacle surmounting mode comprises:
    使所述自主移动设备从当前位置后退第一距离;retreating the autonomous mobile device a first distance from a current location;
    对第二驱动机构制动,并且使第一驱动机构绕所述第二驱动机构向前旋转第一角度,其中所述第一驱动机构和所述第二驱动机构并列设置于所述自主移动设备下部;braking the second drive mechanism and rotating the first drive mechanism forward by a first angle around the second drive mechanism, wherein the first drive mechanism and the second drive mechanism are arranged in parallel on the autonomous mobile device lower part;
    使所述第一驱动机构固定,并且使所述第二驱动机构绕所述第一驱动机构向前旋转第二角度。The first drive mechanism is fixed, and the second drive mechanism is rotated forwardly about the first drive mechanism by a second angle.
  13. 根据权利要求1-9中任一项所述的控制方法,其特征在于,所述越障模式包括:The control method according to any one of claims 1-9, characterized in that the obstacle surmounting mode comprises:
    使所述自主移动设备从被卡住的当前位置后退第一距离;retreating the autonomous mobile device a first distance from a stuck current location;
    使所述自主移动设备加速至第一预设速度,并以所述第一预设速度跨越所述可越障区域中的可跨越型障碍物,其中所述第一预设速度大于所述自主移动设备正常运行时的速度。Accelerating the autonomous mobile device to a first preset speed, and crossing the surmountable obstacle in the obstacle-surpassable area at the first preset speed, wherein the first preset speed is greater than the autonomous mobile device The speed at which the mobile device operates normally.
  14. 根据权利要求1-9中任一项所述的控制方法,其特征在于,所述越障模式包括:The control method according to any one of claims 1-9, characterized in that the obstacle surmounting mode comprises:
    使所述自主移动设备从被卡住的当前位置后退第一距离;retreating the autonomous mobile device a first distance from a stuck current location;
    使所述自主移动设备以后退所述第一距离后的当前方向为初始方向,沿第一旋转方向原地旋转第一设定角度、然后控制所述自主移动设备的运动单元一边向前移动一边沿第二旋转方向旋转第二设定角度,其中所述第二旋转 方向与所述第一旋转方向相反。Make the autonomous mobile device take the current direction after retreating the first distance as the initial direction, rotate the first set angle in situ along the first rotation direction, and then control the motion unit of the autonomous mobile device to move forward by one The edge is rotated by a second set angle along a second rotation direction, wherein the second rotation direction is opposite to the first rotation direction.
  15. 根据权利要求1-9中任一项所述的控制方法,其特征在于,所述越障模式包括:The control method according to any one of claims 1-9, characterized in that the obstacle surmounting mode comprises:
    使所述自主移动设备从被卡住的当前位置后退第二距离;moving the autonomous mobile device back a second distance from a stuck current location;
    使所述自主移动设备以后退所述第二距离后的当前方向为初始方向,沿第三旋转方向原地旋转第三设定角度、然后控制所述自主移动设备的运动单元向前直线移动设定距离。Make the autonomous mobile device take the current direction after retreating the second distance as the initial direction, rotate in situ along the third rotation direction at a third set angle, and then control the motion unit of the autonomous mobile device to move forward in a straight line. fixed distance.
  16. 根据权利要求6所述的控制方法,其特征在于,The control method according to claim 6, characterized in that,
    所述可跨越型障碍物的参数与所述越障模式有对应关系,The parameters of the surmountable obstacle have a corresponding relationship with the obstacle surmounting mode,
    当所述自主移动设备在所述可越障区域被卡住时,根据所述可跨越型障碍物的参数和所述对应关系执行对应的越障模式。When the autonomous mobile device is stuck in the obstacle-crossable area, a corresponding obstacle-crossing mode is executed according to the parameters of the crossable obstacle and the corresponding relationship.
  17. 根据权利要求6所述的控制方法,其特征在于,所述可跨越型障碍物的参数包括形状和/或高度。The control method according to claim 6, wherein the parameters of the surmountable obstacle include shape and/or height.
  18. 一种自主移动设备的控制装置,其特征在于,包括:A control device for autonomous mobile equipment, characterized in that it includes:
    获取单元,用于获取标记有可越障区域的地图;an acquisition unit, configured to acquire a map marked with an obstacle-crossable area;
    判断单元,用于判断所述自主移动设备是否在所述可越障区域被卡住;a judging unit, configured to judge whether the autonomous mobile device is stuck in the obstacle-crossable area;
    处理单元,用于在判断为所述自主移动设备在所述可越障区域被卡住的情况下,命令所述自主移动设备执行越障模式,以尝试通过所述可越障区域;a processing unit, configured to order the autonomous mobile device to execute an obstacle-passing mode in order to try to pass through the obstacle-passable area when it is determined that the autonomous mobile device is stuck in the obstacle-passable area;
    其中,所述判断单元还Wherein, the judgment unit also
    判断所述自主移动设备是否通过了所述可越障区域;judging whether the autonomous mobile device has passed the obstacle-surpassable area;
    在判断为所述自主移动设备未通过所述可越障区域的情况下,所述处理单元在所述地图上将未通过的可越障区域重新标记为不可通过区域。If it is determined that the autonomous mobile device has not passed the obstacle-passable area, the processing unit re-marks the failed obstacle-passable area as an impassable area on the map.
  19. 一种自主移动设备的控制装置,其特征在于,包括:A control device for autonomous mobile equipment, characterized in that it includes:
    处理器;processor;
    用于存储处理器可执行指令的存储器;memory for storing processor-executable instructions;
    其中,所述处理器被配置为:执行权利要求1至17中任一项所述的控制方法的步骤。Wherein, the processor is configured to: execute the steps of the control method described in any one of claims 1-17.
  20. 一种自主移动设备,其特征在于,包括:An autonomous mobile device, comprising:
    根据权利要求18或19所述的控制装置;以及A control device according to claim 18 or 19; and
    运动单元,用于响应于所述控制装置命令所述自主移动设备执行越障模式,以所述越障模式运动以尝试通过所述可越障区域。a motion unit, configured to respond to the control device instructing the autonomous mobile device to execute an obstacle-crossing mode, and to move in the obstacle-crossing mode to try to pass through the obstacle-crossable area.
  21. 一种非临时性计算机可读存储介质,当所述存储介质中的指令由处理器执行时,使得所述处理器能够执行根据权利要求1至17中任一项所述的自主移动设备的控制方法。A non-transitory computer readable storage medium having instructions in the storage medium which, when executed by a processor, enable the processor to perform control of an autonomous mobile device according to any one of claims 1 to 17 method.
PCT/CN2022/136455 2021-12-28 2022-12-05 Autonomous mobile device, control method therefor, apparatus, and storage medium WO2023124788A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202111627977.2 2021-12-28
CN202111627977.2A CN116360410A (en) 2021-12-28 2021-12-28 Autonomous mobile apparatus, control method and apparatus thereof, and storage medium

Publications (1)

Publication Number Publication Date
WO2023124788A1 true WO2023124788A1 (en) 2023-07-06

Family

ID=86910646

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/136455 WO2023124788A1 (en) 2021-12-28 2022-12-05 Autonomous mobile device, control method therefor, apparatus, and storage medium

Country Status (2)

Country Link
CN (1) CN116360410A (en)
WO (1) WO2023124788A1 (en)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009223628A (en) * 2008-03-17 2009-10-01 Toyota Motor Corp Mobile robot and method for generating environment map
CN109872324A (en) * 2019-03-20 2019-06-11 苏州博众机器人有限公司 Ground obstacle detection method, device, equipment and storage medium
CN110393482A (en) * 2019-09-03 2019-11-01 深圳飞科机器人有限公司 Maps processing method and clean robot
CN110477810A (en) * 2018-05-14 2019-11-22 杭州萤石软件有限公司 Control method, device and the sweeping robot of sweeping robot
CN111093019A (en) * 2019-12-30 2020-05-01 科沃斯机器人股份有限公司 Terrain recognition, traveling and map construction method, equipment and storage medium
CN111142526A (en) * 2019-12-30 2020-05-12 科沃斯机器人股份有限公司 Obstacle crossing and operation method, equipment and storage medium
CN111240311A (en) * 2018-11-29 2020-06-05 北京奇虎科技有限公司 Obstacle meeting processing method, device and equipment of sweeping robot and readable storage medium
CN112294192A (en) * 2019-08-01 2021-02-02 惠州拓邦电气技术有限公司 Robot control method and robot
CN112987728A (en) * 2021-02-07 2021-06-18 科益展智能装备有限公司 Robot environment map updating method, system, equipment and storage medium
CN113359742A (en) * 2021-06-18 2021-09-07 云鲸智能(深圳)有限公司 Robot and obstacle crossing method and device thereof, and computer readable storage medium

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009223628A (en) * 2008-03-17 2009-10-01 Toyota Motor Corp Mobile robot and method for generating environment map
CN110477810A (en) * 2018-05-14 2019-11-22 杭州萤石软件有限公司 Control method, device and the sweeping robot of sweeping robot
CN111240311A (en) * 2018-11-29 2020-06-05 北京奇虎科技有限公司 Obstacle meeting processing method, device and equipment of sweeping robot and readable storage medium
CN109872324A (en) * 2019-03-20 2019-06-11 苏州博众机器人有限公司 Ground obstacle detection method, device, equipment and storage medium
CN112294192A (en) * 2019-08-01 2021-02-02 惠州拓邦电气技术有限公司 Robot control method and robot
CN110393482A (en) * 2019-09-03 2019-11-01 深圳飞科机器人有限公司 Maps processing method and clean robot
CN111093019A (en) * 2019-12-30 2020-05-01 科沃斯机器人股份有限公司 Terrain recognition, traveling and map construction method, equipment and storage medium
CN111142526A (en) * 2019-12-30 2020-05-12 科沃斯机器人股份有限公司 Obstacle crossing and operation method, equipment and storage medium
CN112987728A (en) * 2021-02-07 2021-06-18 科益展智能装备有限公司 Robot environment map updating method, system, equipment and storage medium
CN113359742A (en) * 2021-06-18 2021-09-07 云鲸智能(深圳)有限公司 Robot and obstacle crossing method and device thereof, and computer readable storage medium

Also Published As

Publication number Publication date
CN116360410A (en) 2023-06-30

Similar Documents

Publication Publication Date Title
US20230409032A1 (en) Method for controlling an autonomous, mobile robot
CN112739244B (en) Mobile robot cleaning system
US20230064687A1 (en) Restricting movement of a mobile robot
JP6636260B2 (en) Travel route teaching system and travel route teaching method for autonomous mobile object
US11830618B2 (en) Interfacing with a mobile telepresence robot
KR101857952B1 (en) Apparatus and System for Remotely Controlling a Robot Cleaner and Method thereof
US10591921B2 (en) Time-dependent navigation of telepresence robots
CN113164000B (en) Robot vacuum cleaner and cleaning route planning method thereof
KR102490996B1 (en) A robotic cleaning device that changes its operating speed based on the environment
EP4140381A1 (en) Obstacle avoidance method and apparatus for self-walking robot, robot, and storage medium
CN112739505A (en) Investigation of autonomous mobile robot into robot working area
JP2020533720A (en) Exploring an unknown environment with an autonomous mobile robot
JP2022547661A (en) Cleaning robot and its control method
CN107773161A (en) Robot cleaner
CN114402366A (en) Autonomous mobile robot mapping
WO2023124788A1 (en) Autonomous mobile device, control method therefor, apparatus, and storage medium
JP2020119561A (en) System having first floor treatment device and second floor treatment device and operation method for the system
TWI789896B (en) Moving robot system and method of performing collaborative driving of moving robots
CN114527736B (en) Dilemma avoidance method, autonomous mobile device, and storage medium
TWI808210B (en) Self-propelled device, driving control method and driving control program of self-propelled device
TWI837507B (en) Moving robot system
TWI803965B (en) Moving robot, moving robot system and method of performing collaborative driving thereof
WO2024037260A1 (en) Control method of cleaning device, cleaning device, and storage medium
JP2022190894A (en) Traveling-map creating device, self-propelled robot system, traveling-map creating method, and program
AVTANSKI et al. 120 Independent Living for Persons with Disabilities and Elderly People M. Mokhtari (Ed.) IOS Press, 2003 Control of Indoor-operated Autonomous

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22914043

Country of ref document: EP

Kind code of ref document: A1