Path planning method, self-moving device and storage medium
By combining the boundary maps of multiple work areas, planning the moving path based on the work map, and generating obstacle avoidance paths based on obstacles, the problem of low path planning efficiency when multiple work areas in the prior art is solved, and the global Optimal mobile path planning improves the operation efficiency and security of self-mobile devices.
Patent Information
- Application Number
- CN202411120036.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-14
- Publication Date
- 2024-11-26
AI Technical Summary
In the case where multiple working areas are partially overlapped, the mobile path planning efficiency from the mobile device is low, and the global shortest path cannot be obtained, resulting in poor path planning effect.
By obtaining the boundary maps of multiple job areas from the mobile device, the combined process obtains the job map, and the moving path from the first position to the second position is determined based on the job map, including the edge path and the non-edge path, and an avoidance is generated based on the obstacle. Barrier paths, adjust the moving paths to achieve global optimization.
It improves the efficiency and accuracy of path planning, ensures that the global optimal mobile path can be planned in scenarios where multiple working areas have partial overlap, and enhances the operating efficiency and security of the equipment.
Smart Images

Figure CN119022947A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of self-moving equipment, and in particular to a path planning method, a self-moving equipment and a storage medium. Background Art
[0002] With the continuous advancement of science and technology and the rapid development of artificial intelligence, the use of self-moving equipment (such as lawn mowers, cleaning machines, cruise machines, etc.) to perform operations can greatly improve work efficiency.
[0003] In the related art, self-moving devices often perform work tasks according to pre-planned work paths. When encountering an emergency (such as insufficient power) that requires the self-moving device to stop the current work task and move from the current location to the target location (such as the location of the charging device), the self-moving device needs to plan the moving path in time and reach the target location according to the moving path to ensure normal operation. However, when planning the moving path, the existing method needs to go through multiple searches and combinations to determine the locally optimal moving path, and the moving path planning effect is poor. Summary of the invention
[0004] In view of the above, it is necessary to provide a path planning method, a self-moving device and a storage medium, which can solve the technical problem of poor mobile path planning effect.
[0005] In a first aspect, an embodiment of the present application provides a path planning method for a self-moving device, the method comprising: obtaining boundary maps corresponding to multiple operating areas of the self-moving device; merging the boundary maps to obtain an operating map; and determining a moving path from the first position to the second position based on a first position and a second position in the operating map.
[0006] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, obtaining the boundary map corresponding to the multiple operating areas of the self-moving device includes: obtaining multiple boundary contours in response to user operation instructions; based on the multiple boundary contours, determining the boundary map corresponding to the multiple operating areas of the self-moving device, at least two operating areas among the multiple operating areas overlap.
[0007] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, determining the moving path from the first position to the second position based on the work map includes: based on the work map, determining the shortest path from the first position to the second position as the moving path.
[0008] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, determining the moving path from the first position to the second position based on the work map includes: determining a first path from the first position to the area boundary of the work map; determining a second path from the area boundary to the second position; and determining the moving path based on the first path and the second path.
[0009] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, the area boundary includes multiple boundary position points, and the method for determining the first path and the second path includes: determining the boundary position point corresponding to the minimum working distance from the first position to the area boundary of the work map from the multiple boundary position points as the target boundary position point; determining the path from the first position to the target boundary position point as the first path; and determining the shortest path from the target boundary position point to the second position as the second path.
[0010] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, determining the moving path based on the first path and the second path includes: moving from the first position to the target boundary position point based on the first path; moving from the target boundary position point to the second position based on the second path.
[0011] Furthermore, in the above-mentioned path planning method provided in the embodiment of the present application, the method also includes: if there is an obstacle in the moving path, determining an obstacle avoidance path corresponding to the obstacle based on the work map; and adjusting the moving path according to the obstacle avoidance path.
[0012] Furthermore, in the above-mentioned path planning method provided in an embodiment of the present application, after determining the obstacle avoidance path corresponding to the obstacle based on the work map, the method also includes: determining an obstacle avoidance end point corresponding to the obstacle avoidance path; if the obstacle avoidance end point is not in the moving path, based on the work map, determining the shortest path from the obstacle avoidance end point to the second position as the adjusted moving path.
[0013] In a second aspect, an embodiment of the present application provides a path planning device, which is applied to a self-moving device, and the device includes: a map determination module, which is used to obtain boundary maps corresponding to multiple operating areas of the self-moving device; a map merging module, which is used to merge the boundary maps to obtain an operating map; and a path planning module, which is used to determine a moving path from a first position to a second position based on a first position and a second position in the operating map.
[0014] In a third aspect, an embodiment of the present application provides a self-moving device, which includes: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements any of the above-mentioned path planning methods when executing the computer program.
[0015] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor in a mobile device, the path planning method described in any one of the above items is implemented.
[0016] In the charging path planning method of this embodiment, boundary maps corresponding to multiple operating areas of the self-moving device are obtained; the boundary maps are merged to obtain an operating map; based on the first position and the second position in the operating map, a moving path from the first position to the second position is determined. The above method merges multiple operating areas into an operating map to avoid the problem of treating each operating area as an independent map and planning a path in the independent map corresponding to each operating area, which leads to a large number of path planning times, thereby improving the efficiency of path planning; and based on the operating map, the moving path between the first position and the second position is planned, so that the moving path can reach the global optimum, thereby improving the accuracy of path planning. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] Figure 1 It is a schematic diagram of mobile path planning in the related technology provided by an embodiment of the present application.
[0018] Figure 2 It is a schematic diagram of mobile path planning in the related technology provided by another embodiment of the present application.
[0019] Figure 3 It is a flow chart of the path planning method provided in an embodiment of the present application.
[0020] Figure 4 It is a schematic diagram of the operation map provided in the embodiment of the present application.
[0021] Figure 5 It is a schematic diagram of a moving path provided in an embodiment of the present application.
[0022] Figure 6 It is a flowchart of a method for determining a moving path provided in an embodiment of the present application.
[0023] Figure 7 It is a schematic diagram of a moving path provided by another embodiment of the present application.
[0024] Figure 8 It is a flow chart of the obstacle avoidance path determination method provided in an embodiment of the present application.
[0025] Fig. 9 It is a structural diagram of the path planning device provided in an embodiment of the present application.
[0026] Fig.10 It is a schematic diagram of the structure of a self-moving device provided in an embodiment of the present application. DETAILED DESCRIPTION
[0027] In order to make the objectives, technical solutions and advantages of the present application clearer, the present application is described in detail below with reference to the accompanying drawings and specific embodiments.
[0028] It should be noted that in this application, "at least one" means one or more, and "more than one" means two or more than two. "And / or" describes the association relationship of associated objects, indicating that three relationships may exist. For example, A and / or B can mean: A exists alone, A and B exist at the same time, and B exists alone, where A and B can be singular or plural. The terms "first", "second", "third", "fourth", etc. (if any) in the specification, claims and drawings of this application are used to distinguish similar objects, rather than to describe a specific order or sequence.
[0029] In the embodiments of the present application, words such as "exemplary" or "for example" are used to indicate examples, illustrations or descriptions. Any embodiment or design described as "exemplary" or "for example" in the embodiments of the present application should not be interpreted as being more preferred or more advantageous than other embodiments or designs. Specifically, the use of words such as "exemplary" or "for example" is intended to present related concepts in a specific way.
[0030] In the related art, self-moving devices often perform work tasks according to pre-planned work paths. When encountering emergencies that require the self-moving device to stop the current work task and go from the current position to the target position, the self-moving device needs to plan the moving path in time and reach the target position according to the moving path to ensure normal operation. Among them, emergencies may include but are not limited to insufficient power, failures, and the need for cleaning; the target location may include but is not limited to the location of the charging device, the location of the maintenance equipment, and the location of the cleaning equipment. Since charging equipment, maintenance equipment, and cleaning equipment are usually placed at the boundaries of the region, the self-moving device will involve crossing multiple areas in the process of moving to such equipment. And because the travel path of the self-moving device is difficult to cover the edge of the region, or the self-moving device may encounter complex terrain such as irregular regional edges and many obstacles when operating in different areas, the integrity and uniformity of the working environment such as lawns can be ensured by setting overlapping areas. Therefore, in the process of moving to such equipment, the self-moving device often involves crossing multiple areas and there is partial overlap between multiple areas.
[0031] However, most of the existing path planning methods work better in scenarios of a single working area, such as when the current position of the self-moving device and the target position are in the same working area. However, in scenarios involving multiple working areas and partial overlap of the working areas, there are problems such as low efficiency of mobile path planning and inability to obtain the global shortest path, and the mobile path planning effect is poor. For example, taking the example of a self-moving device that needs to be moved to a charging device in time to replenish power due to insufficient power, when planning a moving path from the current position to the position of the charging device, the self-moving device can generate an edge path or a non-edge path, wherein the edge path can be the path of the self-moving device moving along the boundary of the area, and the non-edge path can be the path of the self-moving device moving across the area. The embodiments of the present application illustrate the prior art by taking the two methods of planning edge paths and non-edge paths as examples.
[0032] like Figure 1 As shown, it is a schematic diagram of mobile path planning in the related technology provided by an embodiment of the present application, such as Figure 2 , which is a schematic diagram of mobile path planning in the related technology provided by another embodiment of the present application. Figure 1 and Figure 2 The illustrated operation area includes three areas, namely, operation area A1, operation area A2 and operation area A3. The self-equipping device is at position P1 in operation area A1, and the charging device is at position P2 in operation area A3. Operation area A2 overlaps with operation area A1 at two locations, and operation area A3 overlaps with operation area A2 at one location. In the related art, Figure 1 As shown in the figure, in order to plan the shortest path from position P1 to position P2, the mobile device needs to treat each work area as an independent map, and then plan the shortest path in each independent map. For example, in work area A1, a path from position P1 to position P3 is planned, in work area A2, a path from position P3 to position P4 is planned, and in work area A3, a path from position P4 to position P2 is planned. In this way, the shortest path planning of three independent maps is required to obtain a combined non-edge path.
[0033] like Figure 2 As shown in the figure, in order to plan the path along the edge from position P1 to position P2, the mobile device needs to go through 30 path plannings, plan 30 paths along the edge, and then select the shortest path from the 30 paths along the edge as the moving path. For example, Figure 2The moving path includes the path from P1 to P5, the path from P5 to the overlapping point P6, the path along the edge from P6 to P7, and the path along the edge from P7 to P2. In summary, in the scenario involving multiple working areas and partial overlap of the working areas, the efficiency of planning the path along the edge and the non-path along the edge in the prior art is low, and the moving path obtained by planning is the local shortest path, not the global shortest path.
[0034] In view of this, it is necessary to provide a path planning method, a self-moving device and a storage medium, which can improve the path planning effect of the self-moving device in a scenario where multiple operating areas partially overlap.
[0035] The path planning method provided in the embodiment of the present application can be applied to one or more self-moving devices, which can be lawn mowers, cleaning machines, cruise machines, etc. In other embodiments, the path planning method provided in the embodiment of the present application can also be applied to one or more electronic devices, which can be used to control the movement of the self-moving device, and the electronic device can be a computer, a tablet, a mobile phone, a server, a cloud server, a personal digital assistant (PDA), a game console, an interactive network television (IPTV), a smart wearable device, etc. This application does not limit the types of self-moving devices and electronic devices. The embodiment of the present application is described by taking the path planning method as an example that can be applied to a self-moving device.
[0036] In order to more clearly illustrate the path planning method provided by the embodiments of the present application, the present application will describe the technical solution of the present application in detail through specific embodiments below. It should be noted that the following specific embodiments can be combined with each other, and the same or similar concepts or processes may not be repeated in some embodiments.
[0037] like Figure 3 , which is a flow chart of the path planning method provided by an embodiment of the present application. According to different requirements, the order of each step in the flow chart can be adjusted according to actual requirements, and some steps can be omitted. The method is applied to self-moving equipment (such as lawn mowers, cleaning machines, and cruise machines, etc.).
[0038] S11, obtaining boundary maps corresponding to multiple operation areas of the self-moving device.
[0039] In at least one embodiment of the present application, the self-mobile device may encounter emergencies during operation, and the emergencies may include but are not limited to insufficient power, failure, need for cleaning, and removal of objects in the storage compartment of the device (e.g., fallen leaves, garbage, etc.). In response to the above emergencies, preset devices will be placed at designated locations in the operation area, and the preset devices may include but are not limited to charging devices, maintenance devices, and cleaning devices. For example, when the internal power of the self-mobile device is lower than the preset power threshold, the self-mobile device will be moved to the charging device in time to replenish the power, wherein the preset power threshold can be customized, and the present application does not limit the preset power threshold. For another example, when the self-mobile device fails, the self-mobile device will be moved to the maintenance device in time for maintenance. For another example, when the self-mobile device needs to be cleaned, the self-mobile device will be moved to the cleaning device in time for cleaning. When the self-mobile device encounters the above emergencies, the step of obtaining the boundary map corresponding to the multiple operation areas of the self-mobile device can be executed. In other embodiments, the self-mobile device can provide a human-computer interaction method, and the user can enter the operation instruction in the self-mobile device through a keyboard, a mouse, a remote control, a touchpad or a voice control device. In other embodiments, the self-mobile device may also be communicatively connected with a user terminal, and the user terminal includes but is not limited to any electronic product that can perform human-computer interaction with a user through a keyboard, mouse, remote control, touchpad, or voice control device, such as a personal computer, a tablet computer, a smart phone, a digital camera, etc. The user terminal may also be a control device, such as a remote control or other device. The user may send an operation instruction to the self-mobile device through the user terminal. In one embodiment, the operation instruction may include but is not limited to a charging instruction, a fault handling instruction, and a cleaning instruction. In response to the operation instruction, the self-mobile device may execute the step of obtaining a boundary map corresponding to multiple operation areas of the self-mobile device.
[0040] In some embodiments, the boundary map corresponding to the multiple operation areas of the self-mobile device can be obtained by parsing the user operation instruction, and the user operation instruction is used to indicate the operation area of the self-mobile device. The operation area may include the operation area where the self-mobile device is located, the operation area where the preset device is located, and the operation area that needs to be crossed when the operation area where the self-mobile device is located is reached. The number of operation areas is greater than or equal to 2, and at least two operation areas in the multiple operation areas overlap partially. In multiple operation areas, the operation parameters of each operation area may be the same or different, and this application does not limit this, wherein the operation parameters may include operation parameters such as operation height, operation angle, and operation spacing, and the operation parameters may also include path generation methods such as generating a bow-shaped path and a back-shaped path. Following the above embodiment, the operation area includes operation area A1, operation area A2, and operation area A3, the self-mobile device is at the P1 position in the operation area A1, and the charging device is at the P2 position in the operation area A3. In order to move from the P1 position to the P2 position, the self-mobile device needs to cross the operation area A2.
[0041] In some embodiments, the boundary map may be a Global Positioning System (GPS) map, which may include a two-dimensional or three-dimensional scene map. In practical applications, there is no limitation on the form of the boundary map.
[0042] S12, merging the boundary maps to obtain an operation map.
[0043] In at least one embodiment of the present application, at least two of the multiple work areas partially overlap, and based on this, the overlapping map areas of the multiple work areas are merged to obtain an operation map.
[0044] In some embodiments, merging the boundary maps to obtain the operation map may include: determining the boundary contour corresponding to the boundary map; determining the map area overlapped by the boundary map based on the boundary contour; merging the map areas to obtain the operation map. In some embodiments, the area information contained in the boundary map includes but is not limited to the boundary contour of the operation area, the terrain of the operation area, obstacles, vegetation density and other information. By parsing the boundary map, the boundary contour corresponding to the boundary map can be determined. Among them, the boundary contour refers to the outer limit of the operation area, and the boundary contour can be a collection of multiple coordinate points. By parsing the boundary contour, information such as the perimeter and shape of the operation area can be determined. In some embodiments, at least two of the multiple operation areas partially overlap, and if the boundary contour of one operation area intersects with the boundary contour of another operation area, it is determined that the two operation areas partially overlap, and the area composed of the intersecting boundary contours is used as the map area where the boundary map overlaps. In some embodiments, merging the map areas to obtain the operation map may include: deleting the contour lines of the overlapping parts of the two operation areas (that is, the contour lines corresponding to the overlapping map areas) through a visual processing algorithm (such as OpenCV, etc.), obtaining a merged boundary contour, and using the boundary map corresponding to the merged boundary contour as the operation map.
[0045] For example, Figure 4 The figure shows a schematic diagram of the operation map provided by the embodiment of the present application. Following the above embodiment, there are operation areas A1, A2 and A3. Operation areas A2 and A1 overlap in two places, and operation areas A3 and A2 overlap in one place. Operation areas A1, A2 and A3 are merged, that is, the contour lines of the overlapping parts of the two operation areas are deleted to obtain the merged boundary contour, that is, area boundary I, and the boundary map corresponding to area boundary I is used as the operation map.
[0046] S13: Determine a moving path from the first position to the second position based on the first position and the second position in the operation map.
[0047] In at least one embodiment of the present application, the first position and the second position can be pre-set according to actual needs. For example, the first position can be the position of the self-moving device in the operation map, and the second position can be the position of the preset device in the operation map. In some embodiments, the operation area where the self-moving device is located and the position information of the self-moving device in the area are determined, and the first position of the self-moving device in the operation map can be obtained. Among them, the self-moving device can obtain its current position in a variety of ways. For example, the self-moving device can obtain its current position using real-time dynamic positioning technology (Real-Time Kinematic, RTK). In some embodiments, the operation area where the preset device is located and the position information of the preset device in the area are determined, and the second position of the preset device in the operation map can be obtained. Among them, the preset device is located at or near the regional boundary in the operation map. The embodiment of the present application is described by taking the regional boundary where the preset device is located in the operation map as an example.
[0048] In at least one embodiment of the present application, the moving path may include an edge path and a non-edge path, wherein the edge path may be a path for the self-moving device to move along the area boundary of the work map according to the first position and the second position, and the self-moving device moves from the first position to the second position according to the edge path, which can avoid the trimmed work area from being damaged. The non-edge path may be a path for the self-moving device to move across multiple work areas according to the first position and the second position, and the self-moving device moves from the first position to the second position according to the non-edge path, and can quickly reach the second position so as to respond to emergencies in a timely manner. In some embodiments, the edge path and the non-edge path can be selected according to actual work needs. For example, if the power of the self-moving device is low and cannot meet the long-distance movement, you can choose to generate a non-edge path so that the self-moving device can quickly reach the second position; if the work area to be crossed by the self-moving device has been trimmed, you can choose to generate an edge path to avoid the trimmed work area from being damaged.
[0049] In the charging path planning method of the present embodiment, multiple working areas are merged into a working map to avoid treating each working area as an independent map and planning the path in the independent map corresponding to each working area, which leads to a large number of path planning times. The efficiency of path planning is improved; and the moving path between the first position and the second position is planned based on the working map, so that the moving path can reach the global optimum, thereby improving the accuracy of path planning; in addition, the embodiment of the present application merges multiple working areas into a working map, realizes mobile path planning through one map switching and map generation, avoids unnecessary map switching and map generation operations, and improves the efficiency of mobile path planning.
[0050] In at least one embodiment of the present application, the boundary map corresponding to the multiple operation areas obtained from the mobile device includes: determining multiple boundary contours in response to user operation instructions; based on the multiple boundary contours, determining the boundary map of the multiple operation areas corresponding to the mobile device, and at least two of the multiple operation areas overlap. In some embodiments, the operation area can be drawn by the user according to actual needs. For example, the user obtains the overall boundary map of the operation area in a preset application, and then draws multiple boundary contours in the overall boundary map, and each boundary contour is used as an operation area, so that multiple operation areas and their boundary maps can be obtained. Among them, the overall boundary map of the operation area can be a global positioning system (GPS) map, which can include a two-dimensional or three-dimensional scene map. In practical applications, there is no restriction on the form of the overall boundary map of the operation area. In addition, considering that the travel path of the self-mobile device is difficult to cover the edge of the operation area, or when the self-mobile device operates in different areas, it may encounter complex terrain such as irregular area edges and many obstacles. In order to ensure the operation effect, at least two of the multiple operation areas overlap. In the embodiment of the present application, the boundary map of multiple operation areas is determined in response to the user's operation instruction, so that the operation of the self-mobile device can meet the user's needs.
[0051] In at least one embodiment of the present application, a minimum blank map containing multiple operating areas can also be constructed based on the location information of multiple operating areas, and the merging process of multiple operating areas can be realized on the blank map. In some embodiments, in order to ensure that the boundary contours of multiple operating areas can be fully mapped to the blank map, it is necessary to determine the blank map corresponding to the operating area based on the location information of each operating area. Exemplarily, taking the coordinates of the operating area in the world coordinate system as an example, the horizontal coordinate in the location information of each operating area is determined to obtain multiple horizontal coordinates, and the maximum value of the horizontal coordinate and the minimum value of the horizontal coordinate are determined from the multiple horizontal coordinates, and the difference between the maximum value of the horizontal coordinate and the minimum value of the horizontal coordinate is used as the map length. Taking the coordinates of the operating area in the world coordinate system as an example, the vertical coordinate in the location information of each operating area is determined to obtain multiple vertical coordinates, and the maximum value of the vertical coordinate and the minimum value of the vertical coordinate are determined from the multiple vertical coordinates, and the difference between the maximum value of the vertical coordinate and the minimum value of the vertical coordinate is used as the map width. According to the map length and the map width, a blank map with a regular shape and an area greater than or equal to the map length * map width can be constructed. In some embodiments, the boundary maps corresponding to the multiple operating areas of the self-mobile device are mapped to the blank map, and the merging process is realized on the blank map.
[0052] In at least one embodiment of the present application, when the moving path is a non-edge path, determining the moving path from the first position to the second position includes: based on the operation map, determining the shortest path from the first position to the second position as the moving path. Since a straight line path is the shortest path between two points, the self-moving device can determine the straight line path from the first position to the second position in the operation map as the moving path, and use the moving path as the non-edge path.
[0053] For example, Figure 5 As shown, it is a schematic diagram of the moving path provided by an embodiment of the present application. The operation map includes the regional boundary I after merging the boundary contours of the operation area A1, the boundary contours of the operation area A2, and the boundary contours of the operation area A3, wherein the P1 position is the position of the self-moving device in the operation map (that is, the first position), the P2 position is the position of the preset device in the operation map (that is, the second position), and the P2 position is located on the regional boundary I, and the straight line path from P1 to P2 is determined as the moving path of the self-moving device. The self-moving device can move from the P1 position to the P2 position according to the moving path.
[0054] In at least one embodiment of the present application, when the moving path is a path along the edge, the moving path needs to be planned in combination with the area boundary of the operation map. Figure 6 1 is a flow chart of a method for determining a moving path provided by an embodiment of the present application, and the method for determining a moving path is applied to a self-moving device. Figure 6 As shown, the following steps are included:
[0055] S21, determining a first path from the first position to the area boundary of the operation map.
[0056] In at least one embodiment of the present application, when the moving path is an edge path, the moving path may include a first path from the first position to the regional boundary in the operation map, and a second path from the regional boundary in the operation map to the second position. The first path may be the shortest path from the first position of the self-mobile device to the regional boundary of the operation map, and the method for determining the first path may include: determining the boundary position point corresponding to the minimum operation distance from the first position to the regional boundary of the operation map from the plurality of boundary position points as the target boundary position point; and determining the path from the first position to the target boundary position point as the first path. Exemplarily, the regional boundary of the operation map includes a plurality of boundary position points, each of which has a corresponding boundary tangent, and the self-mobile device may determine the distance from the first position to the boundary tangent of each boundary position point in the regional boundary according to the point-to-line distance formula. The boundary position point with the smallest distance is selected as the target boundary position point. Since the straight line path is the shortest in the path between two points, the self-mobile device may use the straight line path from the first position to the target boundary position point as the first path based on the operation map. In this embodiment, by planning a first path with a minimum working distance from the first position to the area boundary, the distance that the mobile device moves from the first position to the area boundary can be reduced, thereby reducing the impact on the working environment such as the lawn.
[0057] S22: Determine a second path from the area boundary to the second position.
[0058] In at least one embodiment of the present application, the second path may be the shortest path along the edge from the target boundary position point to the second position along the area boundary of the work map from the mobile device, and the method for determining the second path may include: determining the shortest path from the target boundary position point to the second position as the second path. Exemplarily, after determining the target boundary position point, the path along the edge from the target boundary position point to the second position may be determined along two directions (including clockwise and counterclockwise directions) to obtain two paths along the edge, and the shortest path is selected from the two paths along the edge as the second path.
[0059] S23: Determine the moving path according to the first path and the second path.
[0060] In at least one embodiment of the present application, after planning the first path and the second path, the first path and the second path are used as moving paths. For example, the self-moving device can move from the first position to the target boundary position point according to the first path, and then the self-moving device can move from the target boundary position point to the second position according to the second path.
[0061] For example, Figure 7As shown, it is a schematic diagram of a moving path provided by another embodiment of the present application. The operation map includes a regional boundary I after merging the boundary contours of the operation area A1, the boundary contours of the operation area A2, and the boundary contours of the operation area A3, wherein the P1 position is the position of the self-moving device in the operation map (i.e., the first position), the P2 position is the position of the preset device in the operation map (i.e., the second position), the P8 position is the target boundary position point on the regional boundary with the shortest distance from the P1 position, the straight line path from the P1 position to the P8 position is determined as the first path, the edge path from the P8 position to the P2 position is determined as the second path, and the first path and the second path are used as the moving path of the self-moving device.
[0062] In the above method provided in an embodiment of the present application, an edge path can be obtained by determining a first path from the first position to the area boundary of the work map, and a second path from the area boundary to the second position, so that the self-moving device can reach the second position according to the edge path, thereby avoiding damage to the trimmed work area.
[0063] In at least one embodiment of the present application, a self-moving device may encounter obstacles (e.g., birds, animals, people, cars, stones, wood, etc.) when performing cross-region operations according to a moving path. If there are obstacles in the moving path, an obstacle avoidance path can be generated for obstacle avoidance. Figure 8 1 is a flow chart of the obstacle avoidance path determination method provided in the embodiment of the present application, and the obstacle avoidance path determination method is applied to a self-moving device. Figure 8 As shown, the following steps are included:
[0064] S31: If there is an obstacle in the moving path, determine an obstacle avoidance path corresponding to the obstacle based on the operation map.
[0065] In at least one embodiment of the present application, a preset sensor is provided on the self-mobile device for detecting whether there are obstacles in the current moving path. The preset sensor can be set according to actual needs. For example, the preset sensor can include but is not limited to a collision sensor, a depth sensor, an ultrasonic sensor, and an infrared sensor. Exemplarily, the preset sensor can collect detection data in the current moving path once in real time or according to a preset time interval. By analyzing the detection data, it can be determined whether there are obstacles in the moving path. Among them, the data type of the detection data can be determined by the type of the preset sensor. For example, the detection data collected by the collision sensor is impact data, the detection data collected by the depth sensor is depth data, the detection data collected by the ultrasonic sensor is ultrasonic data, and the detection data collected by the infrared sensor is infrared data.
[0066] In some embodiments, if there is no obstacle in the moving path, the moving path is not adjusted, and the self-moving device realizes cross-zone operation according to the moving path; if there is an obstacle in the moving path, an obstacle avoidance path is generated. In some embodiments, the determining of the obstacle avoidance path corresponding to the obstacle may include: determining the characteristic information corresponding to the obstacle; generating the obstacle avoidance path according to the characteristic information based on the operation map. Among them, the characteristic information corresponding to the obstacle may include the shape, contour, position and other information of the obstacle. By determining the characteristic information of the obstacle and generating the obstacle avoidance path according to the characteristic information, the self-moving device can completely bypass the obstacle, improve the accuracy of the obstacle avoidance path determination, and ensure the operation safety of the self-moving device. In one embodiment, the obstacle avoidance path can be a broken line composed of three line segments, so that the self-moving device can operate according to the broken line to bypass the obstacle; in other embodiments, the obstacle avoidance path can also be an arc, so that the self-moving device can operate according to the arc to bypass the obstacle. The shape of the obstacle avoidance path can be set according to actual needs and is not limited here.
[0067] S32: Adjust the moving path according to the obstacle avoidance path.
[0068] In at least one embodiment of the present application, the obstacle avoidance path includes an obstacle avoidance starting point and an obstacle avoidance end point. Since the self-moving device encounters an obstacle during the movement of the moving path, the obstacle avoidance starting point is generally on the moving path, and the obstacle avoidance end point can be set according to actual operation requirements. In one embodiment, the obstacle avoidance starting point and the obstacle avoidance end point of the obstacle avoidance path can both be located in the moving path, so that the self-moving device can continue to operate along the moving path after avoiding the obstacle. In other embodiments, the obstacle avoidance end point of the obstacle avoidance path is not in the moving path. After the self-moving device bypasses the obstacle according to the obstacle avoidance path, the moving path needs to be replanned according to the obstacle avoidance end point of the obstacle avoidance path and the second position. Based on this, the method also includes: if the obstacle avoidance end point is not in the moving path, then based on the operation map, the shortest path from the obstacle avoidance end point to the second position is determined as the adjusted moving path. Exemplarily, a straight line from the obstacle avoidance end point of the obstacle avoidance path to the second position is replanned in the operation map as the adjusted moving path (i.e., a non-edge path). As another example, in the work map, the adjusted moving path (i.e., the edge path) is determined based on the obstacle avoidance end point, the area boundary of the work map, and the second position, wherein the planning method of the edge path has been described in detail in steps S21 to S23 above and will not be repeated here.
[0069] In the above-mentioned path planning method provided in the embodiment of the present application, when there is an obstacle in the moving path, an obstacle avoidance path is generated in the work map based on the characteristic information of the obstacle, which can improve the planning efficiency and accuracy of the obstacle avoidance path; in addition, the embodiment of the present application performs obstacle avoidance path planning based on the work map obtained by merging multiple work areas, which can avoid the problem of clearing historically detected obstacles each time the map is switched or the map is generated when each work area is used as an independent map for obstacle avoidance path planning, thereby improving the operation safety of the self-moving equipment.
[0070] See also Fig. 9 , Fig. 9 2 is a schematic diagram of the structure of the path planning device provided in the embodiment of the present application. In some embodiments, the path planning device 20 may include a plurality of functional modules composed of computer program segments. The computer programs of the various program segments in the path planning device 20 may be stored in the memory of the mobile device and executed by at least one processor to execute (see Figure 3 Description) Path planning function.
[0071] In this embodiment, the path planning device 20 can be divided into multiple functional modules according to the functions it performs. The functional modules may include: a map determination module 201, a map merging module 202, and a path planning module 203. The module referred to in this application refers to a series of computer program segments that can be executed by at least one processor and can complete fixed functions, which are stored in a memory. In this embodiment, the functions of each module will be described in detail in subsequent embodiments.
[0072] The map determination module 201 may be used to obtain boundary maps corresponding to multiple operating areas of the self-mobile device.
[0073] The map merging module 202 may be used to merge the boundary maps to obtain a work map.
[0074] The path planning module 203 may be configured to determine a moving path from the first position to the second position based on the first position and the second position in the operation map.
[0075] It can be understood that the path planning device 20 and the path planning method of the above embodiment belong to the same inventive concept, and the specific implementation method of each module in the path planning device 20 corresponds to the steps of the path planning method in the above embodiment, which will not be repeated in this application.
[0076] The module division described above is a logical function division, and there may be other division methods in actual implementation. In addition, the functional modules in each embodiment of the present application may be integrated in the same processing unit, or each module may exist physically separately, or two or more modules may be integrated in the same unit. The above-mentioned integrated modules may be implemented in the form of hardware or in the form of hardware plus software functional modules.
[0077] like Fig.10 , which is a schematic diagram of the structure of a self-moving device provided in an embodiment of the present application. Fig.10 The mobile device 1 includes a body and a memory 11, a processor 12, a power supply 13, a sensor 14, an operating mechanism 15, a communication module 16, a positioning module 17, a driving wheel 18 and a bus 19 arranged on the body. The processor 12 is coupled to the memory 11, the power supply 13, the sensor 14, the operating mechanism 15, the communication module 16, the positioning module 17, and the driving wheel 18 through the bus 19.
[0078] The memory 11 may include one or more random access memories (RAM) and one or more non-volatile memories (NVM). The random access memory can be directly read and written by the processor 12, and can be used to store executable programs (such as machine instructions) of the operating system or other running programs, and can also be used to store user and application data. The random access memory may include static random-access memory (SRAM), dynamic random access memory (DRAM), synchronous dynamic random access memory (SDRAM), double data rate synchronous dynamic random access memory (DDR SDRAM), etc.
[0079] The non-volatile memory may also store executable programs and user and application data, etc., and may be loaded into the random access memory in advance for direct reading and writing by the processor 12. The non-volatile memory may include a disk storage device and a flash memory.
[0080] The memory 11 is used to store one or more computer programs. The one or more computer programs are configured to be executed by the processor 12. The one or more computer programs include a plurality of instructions, and when the plurality of instructions are executed by the processor 103, the path planning method executed on the mobile device 1 can be implemented.
[0081] In other embodiments, the self-mobile device 1 further includes an external memory interface for connecting to an external memory to expand the storage capacity of the self-mobile device 1 .
[0082] The processor 12 may include one or more processing units, for example, the processor 12 may include an application processor (AP), a modem processor, a graphics processor (GPU), an image signal processor (ISP), a controller, a video codec, a digital signal processor (DSP), a baseband processor, and / or a neural-network processing unit (NPU), etc. Different processing units may be independent devices or integrated into one or more processors.
[0083] The processor 12 provides computing and control capabilities. For example, the processor 12 is used to execute a computer program stored in the memory 11 to implement the above-mentioned path planning method.
[0084] The power source 13 is used to power the self-moving device. In one embodiment of the present application, the power source 13 may include any one or more power supply devices such as a battery, a fuel generator, a solar power generation module, a wind power generation module, etc.
[0085] The sensor 14 is used to obtain information for the mobile device 1, such as obtaining environmental information and movement information of the mobile device 1. In an embodiment of the present application, the sensor 14 may include one or more sensors such as a laser radar, a camera, an infrared sensor, and an encoder.
[0086] The operating mechanism 15 is used to perform corresponding operating tasks, such as mowing, deicing, cruising, cleaning, and spraying pesticides. In some embodiments of the present application, the operating mechanism 15 may include a motor, a transmission mechanism, a cutter disc, and other mechanisms. When the self-moving device is a lawn mower, the motor can drive the cutter disc to rotate through the transmission mechanism to achieve the mowing function. The motor can also control the movement of the blade to adjust the mowing height and mowing area.
[0087] The communication module 16 is used to realize communication between the mobile device and other devices. In one embodiment of the present application, the communication module 16 can exchange data with other devices based on wired communication and / or wireless communication. The above-mentioned wireless communication can include one or more combinations of communication modes such as Bluetooth communication, Wi-Fi communication, and Near Field Communication (NFC).
[0088] The positioning module 17 is used to determine the position of the mobile device. In some embodiments of the present application, the positioning module 17 may include one or more positioning modules of the type of global positioning system (GPS), inertial navigation system, real-time kinematic (RTK) carrier phase differential system, etc.
[0089] The driving wheel 18 is used to realize the movement of the self-moving device. In some embodiments of the present application, the driving wheel 18 can realize the movement function of the self-moving device according to the control of the processor 12. In some embodiments of the present application, the driving wheel 18 may include a left driving wheel and a right driving wheel.
[0090] The bus 19 is at least used to provide a channel for mutual communication among the memory 11 , the processor 12 , the power supply 13 , the sensor 14 , the operating mechanism 15 , the communication module 16 , the positioning module 17 , and the driving wheel 18 in the mobile device 1 .
[0091] In other embodiments of the present application, the self-moving device 1 may further include an anti-collision part and a steering assembly, etc. The anti-collision part may be used to prevent the driving wheel 18 from colliding with an obstacle in front of the self-moving device. The steering assembly may be used to enable the driving wheel 18 to adjust the driving direction.
[0092] It is to be understood that the structure illustrated in the embodiment of the present application does not constitute a specific limitation on the self-moving device 1. In other embodiments of the present application, the self-moving device 1 may include more or fewer components than shown in the figure, or combine some components, or split some components, or arrange the components differently. The components shown in the figure may be implemented in hardware, software, or a combination of software and hardware.
[0093] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described or recorded in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0094] Those of ordinary skill in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of this application.
[0095] The above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit them. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. These modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present application, and should all be included in the protection scope of the present application.
Claims
1. A path planning method, applied to a self-moving device, characterized in that: The method comprises: Obtaining boundary maps corresponding to multiple operating areas of the self-mobile device; Merging the boundary maps to obtain an operation map; Based on a first position and a second position in the work map, a moving path from the first position to the second position is determined.
2. The path planning method according to claim 1, characterized in that: The obtaining of boundary maps corresponding to the multiple operation areas of the self-mobile device includes: In response to a user operation instruction, a plurality of boundary contours are acquired; Based on the multiple boundary contours, the boundary map corresponding to the multiple operation areas of the self-moving device is determined, and at least two of the multiple operation areas overlap.
3. The path planning method according to claim 1, characterized in that: The determining of a moving path from the first position to the second position comprises: Based on the work map, a shortest path from the first position to the second position is determined as the movement path.
4. The path planning method according to claim 1, characterized in that: The determining of a moving path from the first position to the second position comprises: Determining a first path from the first location to an area boundary of the operation map; determining a second path from the region boundary to the second location; The moving path is determined according to the first path and the second path.
5. The path planning method according to claim 4, characterized in that: The area boundary includes a plurality of boundary position points, and the method for determining the first path and the second path includes: Determine, from the plurality of boundary position points, a boundary position point corresponding to the shortest operation distance from the first position to the area boundary of the operation map as a target boundary position point; Determine a path from the first position to the target boundary position point as the first path; The shortest path from the target boundary position point to the second position is determined as the second path.
6. The path planning method according to claim 5, characterized in that: The determining the moving path according to the first path and the second path includes: According to the first path, move from the first position to the target boundary position point; According to the second path, move from the target boundary position point to the second position.
7. The path planning method according to claim 1, characterized in that: The method further comprises: If there is an obstacle in the moving path, determining an obstacle avoidance path corresponding to the obstacle based on the operation map; The moving path is adjusted according to the obstacle avoidance path.
8. The path planning method according to claim 7, characterized in that: After determining the obstacle avoidance path corresponding to the obstacle based on the operation map, the method further includes: Determining an obstacle avoidance endpoint corresponding to the obstacle avoidance path; If the obstacle avoidance endpoint is not in the moving path, based on the operation map, the shortest path from the obstacle avoidance endpoint to the second position is determined as the adjusted moving path.
9. A self-propelled device, characterized in that: The self-mobile device comprises: a memory, a processor, and a computer program stored in the memory and executable on the processor, and the processor implements the path planning method according to any one of claims 1 to 8 when executing the computer program.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, which, when executed by a processor in a mobile device, implements the path planning method according to any one of claims 1 to 8.
