Path planning method and device, autonomous mobile device and storage medium
By obtaining the positional relationship of the control point of the autonomous mobile device and using the corresponding curve path generation strategy, the problem of excessive distance and angle of the curve path generation method is solved, efficient and low-cost path planning is achieved, and the movement efficiency and autonomy are improved. sex.
Patent Information
- Application Number
- CN202310514196.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-08
- Publication Date
- 2024-11-08
AI Technical Summary
The existing curve path generation method cannot generate curve paths that meet the end point accuracy requirements when the autonomous moving device is too close to the target and/or the angle is too large, resulting in low movement efficiency and possible impact on the target.
By obtaining the positional relationships of the starting control point, the target control point, the first control point and the second control point, the corresponding curve path generation strategy is used to generate the curve path of the autonomous mobile device, ensuring that the distance and angle can be too large. Generate paths that meet endpoint accuracy without manual intervention and in-situ rotation.
It is realized that when the autonomous mobile device is too far from the target and angle to the target, it is possible to generate a curve path that meets the end point accuracy, which improves movement efficiency and autonomy and reduces costs.
Smart Images

Figure CN118913268A_ABST
Abstract
Description
Technical Field
[0001] Embodiments of the present application relate to the technical field of autonomous mobile devices, and in particular, to a path planning method, device, autonomous mobile device, and storage medium. Background Art
[0002] In recent years, autonomous mobile devices such as autonomous mobile robots (AMRs), automated guided vehicles (AGVs), or unmanned forklifts have been widely used in various scenarios, such as smart logistics and warehousing scenarios, due to their autonomy and high efficiency. Summary of the invention
[0003] The embodiments of the present application provide a path planning method, device, autonomous mobile device and storage medium to solve the problem that the current curved path generation method cannot generate a curved path for the autonomous mobile device that meets the end point accuracy requirements when the distance between the autonomous mobile device and the target is too close and / or the angle is too large.
[0004] In a first aspect, an embodiment of the present application provides a path planning method. The method includes: obtaining a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of an autonomous mobile device, wherein the second control point is closer to the target control point than the first control point; determining the positional relationship between the starting control point, the target control point, the first control point, and the second control point when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold; and using a curved path generation strategy corresponding to the positional relationship to generate a curved path for the autonomous mobile device.
[0005] In a second aspect, an embodiment of the present application provides a path planning device. The device includes: a data acquisition module, used to acquire a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of an autonomous mobile device, wherein the second control point is closer to the target control point than the first control point; a data processing module, used to determine the positional relationship between the starting control point, the target control point, the first control point, and the second control point when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold; and a path planning module, used to generate a curved path of the autonomous mobile device using a curved path generation strategy corresponding to the positional relationship.
[0006] In a third aspect, an embodiment of the present application provides an autonomous mobile device. The autonomous mobile device includes a memory, one or more processors, and one or more applications. The one or more applications are stored in the memory and are configured to execute the method provided by the embodiment of the present application when called by the one or more processors.
[0007] In a fourth aspect, an embodiment of the present application provides a computer-readable storage medium having a program code stored therein, wherein the program code is configured to execute the method provided by the embodiment of the present application when called by a processor.
[0008] The path planning method, device, autonomous mobile device and storage medium provided by the embodiment of the present application, when the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to the preset angle threshold, according to the positional relationship between the starting control point, the target control point, the first control point and the second control point, a curve path generation strategy corresponding to the positional relationship is used to generate the curve path of the autonomous mobile device, which can ensure that when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the curve generation strategy corresponding to the positional relationship of the above four control points can be used to generate the curve path of the autonomous mobile device, thereby solving the problem that the current curve path generation method cannot generate a curve path of the autonomous mobile device that meets the end point accuracy requirements when the distance between the autonomous mobile device and the target is too close and / or the angle is too large. In addition, since the path planning method provided by the embodiment of the present application can generate a curve path when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, no manual intervention is required, and the autonomous mobile device does not need to have the function of supporting in-situ rotation, the cost is low and the mobility efficiency of the autonomous mobile device during the entire movement process can be improved. BRIEF DESCRIPTION OF THE DRAWINGS
[0009] In order to more clearly illustrate the technical solutions in the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For those skilled in the art, other drawings can be obtained based on these drawings without paying any creative work.
[0010] Figure 1 A schematic diagram of a process flow of a path planning method provided by an embodiment of the present application is shown;
[0011] Figure 2 A schematic diagram of an unmanned forklift and a pallet provided by an exemplary embodiment of the present application is shown;
[0012] Figure 3 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under a first position relationship provided by an exemplary embodiment of the present application is shown;
[0013] Figure 4 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under a second position relationship provided by an exemplary embodiment of the present application is shown;
[0014] Figure 5 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under a third position relationship provided by an exemplary embodiment of the present application is shown;
[0015] Figure 6 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under a fourth position relationship provided by an exemplary embodiment of the present application is shown;
[0016] Figure 7 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under other positional relationships provided by an exemplary embodiment of the present application is shown;
[0017] Figure 8 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under other positional relationships provided by another exemplary embodiment of the present application is shown;
[0018] Fig. 9 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under other positional relationships provided by another exemplary embodiment of the present application is shown;
[0019] Fig.10 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under other positional relationships provided by another exemplary embodiment of the present application is shown;
[0020] Fig.11 A schematic diagram showing a starting control point, a first control point, a second control point, and a target control point under other positional relationships provided by another exemplary embodiment of the present application is shown;
[0021] Fig.12 An exemplary embodiment of the present application provides a Figure 3 The starting control point, the first control point, the second control point and the target control point are shown as a schematic diagram of the effect of the curved path generated by using the first curved path generation strategy;
[0022] Fig.13 An exemplary embodiment of the present application provides a Figure 3 The schematic diagram of the effect of the curve path generated by the second curve path generation strategy using the starting control point, the first control point, the second control point and the target control point shown;
[0023] Fig.14 An exemplary embodiment of the present application provides a Figure 3 The schematic diagram of the effect of the curve path generated by the third curve path generation strategy using the starting control point, the first control point, the second control point and the target control point shown;
[0024] Fig.15 An exemplary embodiment of the present application provides a Figure 4 The schematic diagram of the effect of the curve path generated by the third curve path generation strategy using the starting control point, the first control point, the second control point and the target control point shown;
[0025] Fig.16 An exemplary embodiment of the present application provides a Figure 6 The schematic diagram of the effect of the curve path generated by the third curve path generation strategy using the starting control point, the first control point, the second control point and the target control point shown;
[0026] Fig.17 A schematic diagram of a process flow of a path planning method provided by another embodiment of the present application is shown;
[0027] Fig.18 A schematic diagram of the structure of a path planning device provided in an embodiment of the present application is shown;
[0028] Fig.19 A schematic diagram of the structure of an autonomous mobile device provided in an embodiment of the present application is shown;
[0029] Fig. 20 A schematic diagram of the structure of a computer-readable storage medium provided in an embodiment of the present application is shown. DETAILED DESCRIPTION
[0030] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application.
[0031] At present, the autonomous mobile device can use a spline curve interpolation method or a polynomial interpolation method to generate a curve path of the autonomous mobile device according to the starting point and the target point, and move to the target point according to the curve path, wherein the spline curve interpolation method may include but is not limited to the Bezier curve interpolation method and the B-spline curve method. However, the inventors found in the research that the current curve path generation method is prone to the problem that the autonomous mobile device cannot plan the curve path and reports an error when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, or plans a curve path that exceeds the control ability and mechanical performance of the autonomous mobile device, resulting in the autonomous mobile device being unable to move to the target point according to the terminal accuracy requirement, and even collides with the target or reports an error. That is, the current curve path generation method is unable to generate a curve path of the autonomous mobile device that meets the terminal accuracy requirement when the distance between the autonomous mobile device and the target is too close and / or the angle is too large. Among them, the terminal accuracy requirement refers to the position of the autonomous mobile device (relative to the target) when it reaches the terminal to meet the terminal accuracy requirement and the angle also meets the terminal accuracy requirement.
[0032] When the above problems occur, the current solutions include the following two: one is to use a manual processing method, that is, after the autonomous mobile device reports an error, the autonomous mobile device is manually moved to the target point, or the autonomous mobile device or the target is manually pulled away, and then the autonomous mobile device performs a curved path planning. This manual processing method destroys the autonomy of the system, requires a certain amount of manpower, and has a high cost. In addition, manual processing consumes a certain amount of time, resulting in an increase in the total movement time of the autonomous mobile device and a decrease in the movement efficiency of the autonomous mobile device. The other is to use a method of changing equipment and changing routes, that is, to replace an autonomous mobile device that supports the function of rotating in situ with a more time-consuming and incoherent route, for example, a route in which the autonomous mobile device rotates in situ and moves in a straight line. This method of changing equipment and changing routes requires the autonomous mobile device to support the function of rotating in situ, which is costly. In addition, since the autonomous mobile device needs to slow down, stop, and then accelerate to switch between rotating in situ and moving in a straight line, it will cause the autonomous mobile device to spend more time in the moving process and have a low movement efficiency.
[0033] In order to solve the problem that the current curve path generation method cannot generate a curve path for an autonomous mobile device that meets the end point accuracy requirement when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the inventor, after long-term experimental research, proposed the path planning method, device, autonomous mobile device and storage medium provided in the embodiments of the present application. When the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, the curve path generation strategy corresponding to the positional relationship of the starting control point, the target control point, the first control point and the second control point can be used to generate the curve path of the autonomous mobile device. This ensures that when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the curve path of the autonomous mobile device can be generated using the curve generation strategy corresponding to the positional relationship of the above four control points, thereby solving the problem that the current curve path generation method cannot generate a curve path for the autonomous mobile device that meets the end point accuracy requirement when the distance between the autonomous mobile device and the target is too close and / or the angle is too large.
[0034] Figure 1 A schematic flow chart of a path planning method provided by an embodiment of the present application is shown. The path planning method can be applied to a path planning device or an autonomous mobile device. The autonomous mobile device may include but is not limited to AMR, AGV, and unmanned forklift. The path planning method may include the following steps S110 to S130.
[0035] Step S110, obtaining a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of the autonomous mobile device, wherein the second control point is closer to the target control point than the first control point.
[0036] Among them, the starting control point can be used to characterize the current posture of the autonomous mobile device, wherein the posture includes position and angle, and the angle refers to the angle between the heading of the autonomous mobile device and the horizontal axis of the world coordinate system. It should be noted that the angles or angles referred to here and in the following parts refer to the opposite angles of acute angles, right angles or obtuse angles. The starting control point has position attributes and angle attributes. For example, the starting control point can be expressed as (Ax, Ay, Ath), wherein (Ax, Ay) can be used to represent the position in the current posture of the autonomous mobile device, that is, the horizontal and vertical coordinates of the autonomous mobile device in the world coordinate system, and Ath represents the angle in the current posture of the autonomous mobile device, that is, the angle between the current orientation of the autonomous mobile device and the horizontal axis of the world coordinate system.
[0037] Among them, the target control point can be used to characterize the target posture of the autonomous mobile device, and the target posture can be predetermined according to the target corresponding to the autonomous mobile device, that is, the target control point can be predetermined according to the target corresponding to the autonomous mobile device. The target control point also has position attributes and angle attributes. For example, the target control point can be expressed as (Qx, Qy, Qth), where (Qx, Qy) can be used to represent the position in the target posture of the autonomous mobile device, that is, the predetermined horizontal and vertical coordinates of the autonomous mobile device in the world coordinate system, and Ath represents the angle in the target posture of the autonomous mobile device, that is, the angle between the predetermined orientation of the autonomous mobile device and the horizontal axis of the world coordinate system.
[0038] As an example, see Figure 2 Taking the autonomous mobile device as an unmanned forklift 1 as an example, the current posture of the unmanned forklift 1 can be represented by the starting control point A (Ax, Ay, Ath), and the target corresponding to the unmanned forklift 1 can be the pallet 2. In order to accurately enter the pallet 2, the unmanned forklift 1 needs to reach the target posture before inserting the pallet 2. The target posture can be represented by the target control point Q (Qx, Qy, Qth).
[0039] In some embodiments, the first control point, the second control point, and all control points that will be mentioned later and are between the starting control point and the target control point can also be designed to have both position attributes and angle attributes, thereby improving the accuracy of generating a curved path and reducing the requirements for the control capabilities and mechanical performance of the autonomous mobile device, so that the path planning method provided in the embodiment of the present application can be applied to more autonomous mobile devices.
[0040] The current position and posture of the autonomous mobile device can be obtained through an external sensing device on the autonomous mobile device to determine a starting control point for characterizing the current position and posture. The sensing device may include multiple sensors, and the types of the multiple sensors may be the same or different. For example, the multiple sensors may include but are not limited to cameras, laser sensors, millimeter wave sensors, ultra-wideband sensors, and infrared sensors.
[0041] In some embodiments, the target control point can be pre-determined according to the target corresponding to the autonomous mobile device and stored in the autonomous mobile device. When the curve path planning function is started, the pre-stored target control point can be directly read, thereby saving time in determining the target control point.
[0042] In other embodiments, the target control point can also be calculated based on the position and posture of the target corresponding to the autonomous mobile device. For example, the autonomous mobile device can obtain the position and posture of the target corresponding to it, determine the target position and posture of the autonomous mobile device based on the target position and posture, and determine the target control point based on the target position and posture. The position and posture of the target may include the horizontal and vertical coordinates of the target in the world coordinate system, and the angle between the direction of the target and the horizontal axis of the world coordinate system. Figure 2 As shown, the target is pallet 2, and the orientation of pallet 2 is horizontal to the right, that is, the angle between pallet 2 and the horizontal axis of the world coordinate system is 0, then the angle in the target posture of the unmanned forklift 1 can be determined to be 0, and accordingly, the angle in the target posture of the autonomous mobile device can be determined to be 0. The position in the target posture of the unmanned forklift 1 can have a certain distance from the position in the posture of the pallet 2, and the certain distance can be set according to actual needs.
[0043] After determining the starting control point and the target control point, the first control point and the second control point can be determined between the starting control point and the target control point. In some embodiments, considering the computational complexity, whether the Runge phenomenon occurs, whether the low-order realizability is low, whether the polynomial degree is independent of the number of control points, and whether the curve path can be locally controlled, the embodiment of the present application can use a B-spline curve with relatively simple computational complexity, no Runge phenomenon, low-order realizability, polynomial degree independent of the number of control points, and local control of the curve path for path planning. The scheme of the four control points in the embodiment of the present application uses a cubic B-spline curve as an example. According to the properties of the cubic B-spline curve, the angle of the first control point is the same as the angle of the starting control point, and both are angles in the current posture of the autonomous mobile device, that is, the angle between the current orientation of the autonomous mobile device and the horizontal axis of the world coordinate system. The angle of the second control point is the same as the angle of the target control point, and both are angles in the target posture of the autonomous mobile device, that is, the angle between the target orientation of the autonomous mobile device and the horizontal axis of the world coordinate system. It should be noted that in actual applications, B-spline curves of other orders may be selected according to actual needs, and spline curve interpolation methods other than B-spline curves or polynomial interpolation methods may be used to generate curve paths, and the embodiments of the present application do not impose specific restrictions here. Among them, spline curve interpolation methods other than B-spline curves may also include Bezier curve interpolation methods.
[0044] Step S120, when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, determine the positional relationship between the starting control point, the target control point, the first control point and the second control point.
[0045] The preset distance threshold in the embodiment of the present application can be used to constrain the distance relationship between the autonomous mobile device and its corresponding target, and is a criterion for determining whether the autonomous mobile device is too close to the target. The preset distance threshold can be set comprehensively based on factors such as the control capability and mechanical performance of the autonomous mobile device in actual application. For example, the preset distance threshold can be set to a value less than or equal to 2 times the length of the autonomous mobile device. For example, the preset distance threshold can be set to 1.9 times the length of the autonomous mobile device. Figure 2 As shown, if the distance between the autonomous mobile device (unmanned forklift 1) and the target (pallet 2) is less than 1.9 times the length of the autonomous mobile device, it is considered that the distance between the autonomous mobile device and the target is too close.
[0046] The preset angle threshold in the embodiment of the present application can be used to constrain the angular relationship between the autonomous mobile device and its corresponding target, and is a criterion for determining whether the angle between the autonomous mobile device and the target is too large. The preset angle threshold can be set comprehensively based on factors such as the control capability and mechanical performance of the autonomous mobile device in actual application. For example, the preset angle threshold can be set to any value greater than or equal to 10 and less than or equal to 180 degrees. For example, the preset angle threshold can be 10.5 degrees. It should be noted that the preset angle threshold is set to be less than or equal to 180 here because the embodiment of the present application uses the absolute value of the angle difference between the autonomous mobile device and its corresponding target to compare with the preset angle threshold. For example, Figure 2 As shown, if the absolute value of the difference between the angle in the current posture of the autonomous mobile device and the angle in the target posture is greater than or equal to 10.5 degrees and less than or equal to 180 degrees (10.5°≤|Qth-Ath|≤180°), it is considered that the angle between the autonomous mobile device and the target is too large.
[0047] In view of increasingly complex application scenarios, in order to enable autonomous mobile devices to complete related tasks more accurately and efficiently (such as the above Figure 2 The unmanned forklift 1 is inserted into the pallet 2 as shown), which requires the autonomous mobile device to consider not only the position during the movement, but also the angle during the movement. Therefore, the embodiment of the present application comprehensively considers the position and angle of the autonomous mobile device to determine whether the curved path needs to be further adjusted. The inventors found in their research that when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold (for the specific determination process, please refer to the relevant parts in the subsequent steps S220 to S240, which are not described in detail here), it can be determined that the distance between the autonomous mobile device and the target is too close and / or the angle is too large, such as Figure 2As shown, the distance between the starting control point A and the target control point Q of the unmanned forklift 1 is too close and the angle is too large. At this time, if the starting control point, the first control point, the second control point and the target control point are directly used to generate a curved path, a curved path that exceeds the control capability of the autonomous mobile device will be planned, resulting in a large angle error after the autonomous mobile device moves to the target point, and even collides with the target, causing the system to encounter an error. At this time, it is necessary to further determine whether to adjust the curved path generation strategy based on the starting control point, the first control point, the second control point and the target control point.
[0048] If it is determined that the curve path generation strategy needs to be adjusted based on the starting control point, the first control point, the second control point and the target control point, then either the control points used to generate the curve path can be adjusted, and then the original curve path generation strategy can be used to generate the curve path of the autonomous mobile device based on the adjusted new control points (for example, the first curve path generation strategy to be mentioned later in this application); or the position of the autonomous mobile device can be adjusted, and then the original curve path generation strategy can be used to generate the curve path of the autonomous mobile device based on the adjusted new control points (for example, the second curve path generation strategy and the third curve path generation strategy to be mentioned later in this application).
[0049] If it is determined that there is no need to adjust the curve path generation strategy based on the starting control point, the first control point, the second control point and the target control point, the original curve path generation strategy (i.e., the fourth curve path generation strategy to be mentioned later in the embodiment of the present application) can be used to generate the curve path of the autonomous mobile device based on the starting control point, the first control point, the second control point and the target control point.
[0050] In an embodiment of the present application, the positional relationship between the starting control point, the first control point, the second control point and the target control point can be determined, and the curve path generation strategy corresponding to the positional relationship can be determined based on the positional relationship, thereby completing the operation of adjusting or not adjusting the curve path generation strategy.
[0051] The positional relationship between the starting control point, the first control point, the second control point and the target control point in the embodiment of the present application may include one of the following first positional relationship, second positional relationship, third positional relationship and other positional relationships:
[0052] (1) The first position relationship is: the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point intersects the straight line where the target control point and the second control point are located, and the intersection point of the line segment formed by the starting control point and the first control point and the straight line where the target control point and the second control point are located is not the starting control point and the first control point. In the embodiment of the present application, the curve path generation strategy corresponding to the first position relationship may include one of the first curve path generation strategy, the second curve path generation strategy, and the third curve path generation strategy.
[0053] As an example, see Figure 3 , A is the starting control point, B is the first control point, C is the second control point, Q is the target control point, A, B, C, Q satisfy "C and D are on the same side of the straight line AB, and the line segment AB intersects the straight line CQ and the intersection point is not A and B", it can be determined that the positional relationship of A, B, C, Q is the first positional relationship.
[0054] (2) The second positional relationship is: the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point does not intersect the straight line where the target control point and the second control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is less than the distance from the target control point to the straight line where the starting control point and the first control point are located. At this time, the distance from the first control point to the straight line where the target control point and the second control point are located will be greater than the distance from the starting control point to the straight line where the target control point and the second control point are located. In the embodiment of the present application, the curve path generation strategy corresponding to the second positional relationship may include one of the second curve path generation strategy and the third curve path generation strategy.
[0055] As an example, see Figure 4 , A is the starting control point, B is the first control point, C is the second control point, Q is the target control point, A, B, C, Q satisfy "C, Q are on the same side of line AB, and line segment AB does not intersect line CQ, and the distance from C to line AB is less than the distance from Q to line AB, and the distance from B to line CQ is greater than the distance from A to line CQ", it can be determined that the positional relationship of A, B, C, Q is the second positional relationship.
[0056] (3) The third position relationship is: the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point and the straight line where the target control point and the second control point are located intersect at the starting control point. In the embodiment of the present application, the curve path generation strategy corresponding to the third position relationship may include one of the second curve path generation strategy and the third curve path generation strategy.
[0057] As an example, see Figure 5 , A is the starting control point, B is the first control point, C is the second control point, Q is the target control point, A, B, C, Q satisfy "C, Q are on the same side of the straight line AB, and the line segment AB and the straight line CQ intersect at point A", it can be determined that the positional relationship of A, B, C, Q is the third positional relationship.
[0058] (4) The fourth position relationship is: the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is greater than or equal to the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the straight line where the second control point and the target control point are located is less than or equal to the distance from the starting control point to the straight line where the second control point and the target control point are located. In particular, in the critical case where the above two relationships "the distance from the second control point to the straight line where the starting control point and the first control point are located is equal to the distance from the target control point to the straight line where the starting control point and the first control point are located" and "the distance from the first control point to the straight line where the second control point and the target control point are located is equal to the distance from the starting control point to the straight line where the second control point and the target control point are located" are satisfied at the same time, the straight line where the second control point and the target control point are located is parallel to the straight line where the starting control point and the first control point are located. In the embodiment of the present application, the curve path generation strategy corresponding to the fourth position relationship is the third curve path generation strategy.
[0059] As an example, see Figure 6 , A is the starting control point, B is the first control point, C is the second control point, Q is the target control point, A, B, C, Q satisfy "C, Q are on the same side of straight line AB, and line segment AB does not intersect straight line CQ, and the distance from C to straight line AB is greater than the distance from Q to straight line AB, and the distance from B to straight line CQ is less than the distance from A to straight line CQ", it can be determined that the positional relationship of A, B, C, Q is the third positional relationship.
[0060] (5) Other positional relationships other than the first positional relationship, the second positional relationship, the third positional relationship, and the fourth positional relationship. In the embodiment of the present application, for other positional relationships, a cubic B-spline curve can be directly generated as the curve path of the autonomous mobile device according to the starting control point, the first control point, the second control point, and the target control point, or the curve path of the autonomous mobile device can be generated using the fourth curve path generation strategy. For example, other positional relationships may include the following positional relationships:
[0061] (5-1) The starting control point, the first control point, the second control point and the target control point are located on the same straight line. As an example, Figure 7As shown, A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. A, B, C, and Q satisfy the "ABCQ four points are collinear", and the positional relationship of A, B, C, and Q can be determined to be other positional relationships.
[0062] (5-2) The second control point is located on the straight line where the first control point and the starting control point are located. As an example, Figure 8 As shown, A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. A, B, C, and Q satisfy "C is on the straight line AB", and the positional relationship of A, B, C, and Q can be determined to be other positional relationships.
[0063] (5-3) The second control point and the target control point are on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point does not intersect the straight line where the second control point and the target control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is less than the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the second control point and the target control point is less than the distance from the starting control point to the second control point and the target control point. As an example, Fig. 9 As shown, A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. A, B, C, and Q satisfy "C and Q are on the same side of the straight line AB, and the line segment AB does not intersect the straight line CQ, and the distance from C to the straight line AB is less than the distance from Q to the straight line AB, and the distance from B to the straight line CQ is less than the distance from A to the straight line CQ". It can be determined that the positional relationship of A, B, C, and Q is other positional relationships.
[0064] (5-4) The second control point and the target control point are on both sides of the straight line where the starting control point and the first control point are located. As an example, Fig.10 As shown, A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. A, B, C, and Q satisfy "C and Q are on both sides of straight line AB". The positional relationship of A, B, C, and Q can be determined to be other positional relationships.
[0065] (5-5) The second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the straight line where the second control point and the target control point are located and the straight line where the starting control point and the first control point are located intersect at the first control point. As an example, Fig.11 As shown, A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. A, B, C, and Q satisfy "C and Q are on both sides of straight line AB". The positional relationship of A, B, C, and Q can be determined to be other positional relationships.
[0066] (5-6) Other positional relationships not listed here.
[0067] Step S130 , using a curve path generation strategy corresponding to the position relationship to generate a curve path for the autonomous mobile device.
[0068] In some implementations, when the positional relationship is the first positional relationship, one of the first curved path generation strategy, the second curved path generation strategy, and the third curved path generation strategy may be used to generate a curved path for the autonomous mobile device.
[0069] Specifically, when the position relationship is the first position relationship, the current surrounding environment information of the autonomous mobile device can be obtained; based on the surrounding environment information, one of the first curve path generation strategy, the second curve path generation strategy and the third curve path generation strategy is adopted to generate the curve path of the autonomous mobile device.
[0070] In some embodiments, when the position relationship is the first position relationship, if it is determined based on the surrounding environment information that there is no adjustment space for the autonomous mobile device to move backward, a first curved path generation strategy may be used to generate a curved path for the autonomous mobile device. The adjustment space requirement for the autonomous mobile device to move backward may be pre-set and stored in the autonomous mobile device, and the pre-set and stored adjustment space requirement for the autonomous mobile device to move backward may be called at any time during the process of generating the curved path.
[0071] In some embodiments, when the position relationship is the first position relationship, if it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn, one of the first curve generation strategy and the second curve path generation strategy can be used to generate a curved path for the autonomous mobile device. The adjustment space requirement for the autonomous mobile device to turn can be pre-set and stored in the autonomous mobile device, and the pre-set and stored adjustment space requirement for the autonomous mobile device to turn can be called at any time during the process of generating the curved path.
[0072] In some embodiments, when the position relationship is a first position relationship, if it is determined based on surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn, one of the first curve path generation strategy, the second curve path generation strategy, and the third curve path generation strategy is adopted to generate a curve path for the autonomous mobile device.
[0073] In some embodiments, when the positional relationship is the second positional relationship or the third positional relationship, one of the second curved path generation strategy and the third curved path generation strategy may be used to generate a curved path for the autonomous mobile device.
[0074] Specifically, when the position relationship is the second position relationship or the third position relationship, the current surrounding environment information of the autonomous mobile device can be obtained; based on the surrounding environment information, one of the second curve path generation strategy and the third curve path generation strategy is adopted to generate a curve path of the autonomous mobile device.
[0075] In some embodiments, when the position relationship is the second position relationship or the third position relationship, if it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn, a second curve path generation strategy can be used to generate a curve path for the autonomous mobile device.
[0076] In some embodiments, when the position relationship is the second position relationship or the third position relationship, if it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn, one of the second curve path generation strategy and the third curve path generation strategy can be used to generate a curve path for the autonomous mobile device.
[0077] In some implementations, when the positional relationship is the fourth positional relationship, the third curved path generation strategy may be used to generate a curved path for the autonomous mobile device.
[0078] The above-mentioned "using the first curve path generation strategy to generate a curve path for the autonomous mobile device" (i.e., the first curve path generation strategy) may include the following steps: determining the intersection of the straight line where the starting control point and the first control point are located and the straight line where the target control point and the second control point are located; then, based on the starting control point, the intersection point, the second control point and the target control point, directly generating a third-order B-spline curve or using the fourth curve path generation strategy to generate the curve path for the autonomous mobile device.
[0079] As an example, see Fig.12 , A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. Fig.12 The position relationship of A, B, C, Q in Figure 3 The positional relationship of A, B, C, and Q in is the same, that is, Fig.12 The positional relationship among A, B, C, and Q in is the first positional relationship. Assuming that Fig.12 A, B, C, Q in the above code are directly generated as follows: Fig.12The old curve in the image is generated with two turning directions, namely, turn right first and then turn left. Since the distance between the autonomous mobile device and the target is too close and / or the angle is too large, and the mechanical performance and control ability of the autonomous mobile device are limited, the autonomous mobile device cannot move to the target control point according to the old curve while meeting the control accuracy. In the case where A, B, C, and Q satisfy the first positional relationship, the first curve path generation strategy in the embodiment of the present application is adopted, that is, the intersection point P of the straight line AB and the straight line CQ is determined, and A, P, C, and Q are determined as the new four control points. Based on A, P, C, and Q, a cubic B-spline curve is directly generated as the curve path, or the fourth curve path generation strategy is used to generate the curve path. The curve path is as follows: Fig.12 As shown in the new curve, Fig.12 The new curve in has only one turning direction, compared to Fig.12 The old curve in can improve the accuracy of the autonomous mobile device moving to the target control point Q.
[0080] The first curve path generation strategy in the embodiment of the present application only needs to calculate the above-mentioned intersection point, and the control point used to generate the curve path is changed by changing the original first control point to the intersection point. The autonomous mobile device does not need to move, which can save time and adjustment space. However, the adjustment range of the first curve path generation strategy may be small, and the effect of improving the accuracy of moving the autonomous mobile device to the target control point is limited. In addition, when the line segment formed by the starting control point and the first control point is much shorter than the line segment formed by the starting control point and the target control point, for example, the ratio of the line segment formed by the starting control point and the first control point to the line segment formed by the starting control point and the target control point is less than 1 / 10, the first curve path generation strategy may make the curvature of the curve near the first control point too large, and the smaller the ratio, the greater the curvature, making it difficult to control the autonomous mobile device to reach the end point under the control accuracy. Therefore, when the line segment formed by the starting control point and the first control point is much shorter than the line segment formed by the starting control point and the target control point, it is not recommended to use the first curve path generation strategy to generate the curve path. Due to the mechanical performance and control capability of the equipment, the accuracy requirements are different, and the above ratio needs to be determined according to the actual situation.
[0081] The above-mentioned "using the second curve path generation strategy to generate a curve path for the autonomous mobile device" may include the following steps: determining the intersection of the straight line where the starting control point and the first control point are located and the straight line where the second control point and the target control point are located; determining a third control point on a ray formed by the first control point as an endpoint and passing through the starting control point, the third control point being farther from the starting control point than the intersection point; determining a fourth control point on a line segment formed by the intersection point and the third control point, the fourth control point not being the third control point; generating an adjustment path for the autonomous mobile device based on the starting control point and the third control point, generating a curve path for the autonomous mobile device based on the third control point, the fourth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path to a position corresponding to the third control point, and the autonomous mobile device moves along the curve path from a position corresponding to the third control point to a position corresponding to the target control point. That is, by using the second curve path generation strategy, the autonomous mobile device can automatically move backward according to the adjustment path and then move to the end point according to the curve path to complete autonomous adjustment without manual intervention, thereby improving the mobility efficiency and autonomy of the autonomous mobile device.
[0082] The closer the fourth control point is to the intersection point, the smaller the curvature of the curve corresponding to the fourth control point and the target control point is, and it is easier to control the vehicle to move accurately to the target control point. It is recommended that the fourth control point directly use the intersection point in implementation, which saves the generation of a new control point and makes the vehicle easier to control.
[0083] As an example, see Fig.13 , A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. Fig.13 The position relationship of A, B, C, Q in Figure 3 The positional relationship of A, B, C, and Q in is the same, that is, Fig.13 The positional relationship among A, B, C, and Q in is the first positional relationship. Assuming that Fig.13 A, B, C, Q in the above code are directly generated as follows: Fig.13The generated old curve has two turning directions, namely, first turning right and then turning left. Since the distance between the autonomous mobile device and the target is too close and / or the angle is too large, and the mechanical performance and control ability of the autonomous mobile device are limited, the autonomous mobile device cannot move to the target control point according to the control accuracy requirement along the old curve. When A, B, C, and Q satisfy the first position relationship, the second curve path generation strategy in the embodiment of the present application is adopted, that is, the intersection point P of the straight line AB and the straight line CQ is determined, and the third control point A' is determined on the ray BA, requiring A' to be farther away from A than P, and A'P is determined according to the movable space and actual needs (the larger the A'P, the smaller the curvature near the point A' in the subsequently generated curve path, but the longer the AA' time. The line segment AA' is the moving route of the autonomous mobile device moving backward.) The fourth control point B' is determined on the line segment PA' (excluding A'), and the fourth control point B' is as close to the intersection point P as possible. An adjustment path is generated based on A and A', and a cubic B-spline curve is generated as a curve path based on the new four control points A', B', C, and Q, or a curve path is generated using the fourth curve path generation strategy. The curve path is as follows Fig.13 As shown in the new curve, Fig.13 The new curve in has only one turning direction, compared to Fig.13 The old curve in can improve the accuracy of the autonomous mobile device moving to the target control point Q.
[0084] The second curve path generation strategy in the embodiment of the present application can control the autonomous mobile device to retreat into the adjustment space, and re-plan the next curve path after retreating. The adjustment optimization range is large, which can greatly improve the accuracy of moving the autonomous mobile device to the target control point.
[0085] The above-mentioned "using the third curve path generation strategy to generate a curve path for the autonomous mobile device" may include the following steps: determining a fifth control point on a ray formed by passing through the starting control point with the second control point as the endpoint, the fifth control point being farther from the first control point than the starting control point; determining a sixth control point on a line segment formed by the starting control point and the fifth control point; determining a seventh control point on a ray passing through the starting control point with the first control point as the endpoint, the seventh control point being farther from the first control point than the starting control point; generating an adjustment path according to the starting control point, the seventh control point, the sixth control point and the fifth control point, generating a curve path for the autonomous mobile device according to the fifth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path and turns to the position corresponding to the fifth control point, and the autonomous mobile device moves along the curve path from the position corresponding to the fifth control point to the position corresponding to the target control point. That is, by using the third curve path generation strategy, the autonomous mobile device can automatically move backward and turn according to the adjustment path, and then move to the end point according to the curve path, completing autonomous adjustment without manual intervention, thereby improving the mobility efficiency and autonomy of the autonomous mobile device.
[0086] In some embodiments, the angle formed by the starting control point, the seventh control point and the sixth control point with the seventh control point as the vertex is an obtuse angle, which can reduce the curvature of the generated adjustment curve path, thereby more accurately controlling the autonomous mobile device to move to the position corresponding to the fifth control point.
[0087] As an example, see Fig.14 , A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. Fig.14 The position relationship of A, B, C, Q in Figure 3 The positional relationship of A, B, C, and Q in is the same, that is, Fig.14 The positional relationship among A, B, C, and Q in is the first positional relationship. Assuming that Fig.14 A, B, C, Q in the above code are directly generated as follows: Fig.14In the old curve in, the generated old curve has two turning directions, namely, first turn right and then turn left. Since the distance between the autonomous mobile device and the target is too close and / or the angle is too large, and the mechanical performance and control ability of the autonomous mobile device are limited, the autonomous mobile device cannot move to the target control point according to the control accuracy requirement according to the old curve. In the case where A, B, C, and Q meet the first position relationship, the third curve path generation strategy provided in the embodiment of the present application is adopted, that is, the fifth control point D is determined on the ray CA (that is, D is determined on the extension line of the line segment CA), and D is required to be farther from B than A. The sixth control point E is determined on the line segment AD. The seventh control point F is determined on the ray BA (that is, F is determined on the extension line of the line segment BA), and F is required to be farther from B than A. Among them, F can be selected so that the ∠AFE formed by A, F, and E with F as the vertex is an obtuse angle, which can reduce the curvature of the generated adjustment curve path, so that the autonomous mobile device can be more accurately controlled to move to the position corresponding to the fifth control point. Based on the control points A, F, E, and D, the B-spline curve interpolation method is used to generate the adjustment path. Based on the three control points D, C, and Q or based on the four control points D, E, C, and Q, a third-order B-spline curve is directly generated as the curve path or the fourth curve path generation strategy is used to generate the curve path. The curve path is as follows: Fig.14 As shown in the new curve in , when there are only three points D, C, and Q, the four control points are D, C, C, and Q. Fig.14 The new curve in has only one turning direction, compared to Fig.14 The old curve in can improve the accuracy of the autonomous mobile device moving to the target control point Q.
[0088] As another example, see Fig.15 , A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. Fig.15 The position relationship of A, B, C, Q in Figure 4 The positional relationship of A, B, C, and Q in is the same, that is, Fig.15 The positional relationship among A, B, C, and Q in is the second positional relationship. Assuming that Fig.15 A, B, C, Q in the above code are directly generated as follows: Fig.15In the old curve, the generated old curve has two turning directions, namely, first turn right and then turn left. Since the distance between the autonomous mobile device and the target is too close and / or the angle is too large, and the mechanical performance and control ability of the autonomous mobile device are limited, the accuracy requirement of the autonomous mobile device moving to the target control point according to the old curve does not meet the accuracy requirement of the end point. In the case where A, B, C, and Q meet the second position relationship, the third curve path generation strategy in the embodiment of the present application is adopted, that is, the fifth control point D is determined on the ray CA (that is, D is determined on the extension line of the line segment CA), and D is required to be farther from B than A. The sixth control point E is determined on the line segment AD. The seventh control point F is determined on the ray BA (that is, F is determined on the extension line of the line segment BA), and F is required to be farther from B than A. Among them, F can be selected so that the ∠AFE formed by A, F, and E with F as the vertex is an obtuse angle, which can reduce the curvature of the generated adjustment curve path, so that the autonomous mobile device can be more accurately controlled to move to the position corresponding to the fifth control point. Based on the control points A, F, E, and D, the B-spline curve interpolation method is used to generate the adjustment path. Based on the three control points D, C, and Q or based on the four control points D, E, C, and Q, a third-order B-spline curve is directly generated as the curve path or the fourth curve path generation strategy is used to generate the curve path. The curve path is as follows: Fig.15 As shown in the new curve in , when there are only three points D, C, and Q, the four control points are D, C, C, and Q. Fig.15 The new curve in has only one turning direction, compared to Fig.15 The old curve in can improve the accuracy of the autonomous mobile device moving to the target control point Q.
[0089] As another example, see Fig.16 , A is the starting control point, B is the first control point, C is the second control point, and Q is the target control point. Fig.16 The position relationship of A, B, C, Q in Figure 6 The positional relationship of A, B, C, and Q in is the same, that is, Fig.16 The positional relationship among A, B, C, and Q in is the second positional relationship. Assuming that Fig.16 A, B, C, Q in the above code are directly generated as follows: Fig.16In the old curve, the generated old curve has two turning directions, namely, turning right first and then turning left. Since the distance between the autonomous mobile device and the target is too close and / or the angle is too large, and the mechanical performance and control ability of the autonomous mobile device are limited, the accuracy requirement of the autonomous mobile device moving to the target control point according to the old curve does not meet the accuracy requirement of the end point. In the case where A, B, C, and Q meet the second position relationship, the third curve path generation strategy provided in the embodiment of the present application is adopted to determine the fifth control point D on the ray CA (that is, determine D on the extension line of the line segment CA), and require that D is farther from B than A. Determine the sixth control point E on the line segment AD. Determine the seventh control point F on the ray BA (that is, determine F on the extension line of the line segment BA), and require that F is farther from B than A. Among them, F can be selected so that the ∠AFE formed by A, F, and E with F as the vertex is an obtuse angle, which can reduce the curvature of the generated adjustment curve path, so that the autonomous mobile device can be more accurately controlled to move to the position corresponding to the fifth control point. Based on the control points A, F, E, and D, the B-spline curve interpolation method is used to generate the adjustment path. Based on the three control points D, C, and Q or based on the four control points D, E, C, and Q, a third-order B-spline curve is directly generated as the curve path or the fourth curve path generation strategy is used to generate the curve path. The curve path is as follows: Fig.16 As shown in the new curve in , when there are only three points D, C, and Q, the four control points are D, C, C, and Q. Fig.16 The new curve in has only one turning direction, compared to Fig.16 The old curve in can improve the accuracy of the autonomous mobile device moving to the target control point Q.
[0090] The third curve path generation strategy in the embodiment of the present application can control the autonomous mobile device to move backward and turn to the position corresponding to the fifth control point, and re-plan the next curve path after reaching the position corresponding to the fifth control point. The adjustment optimization range is the largest, and the accuracy of moving the autonomous mobile device to the target control point can be greatly improved. However, the third curve path generation strategy requires a large adjustment space. If the curvature of the curve path generated by the first curve path generation strategy or the second curve path generation strategy is small and can meet the control accuracy requirements, it is recommended to adopt the first curve path generation strategy or the second curve path generation strategy instead of the third curve path generation strategy.
[0091] In some embodiments, after the curve path is generated using the third curve path generation strategy, whether the curvature of the curve corresponding to the second control point and the target control point in the generated curve path is greater than a preset curvature threshold can be used to indicate whether the end point can be reached within the control accuracy range, and whether the curve path is further adjusted can be determined. If the curvature of the curve corresponding to the second control point and the target control point in the generated curve path is less than or equal to the preset curvature threshold, the generated curve path may not be adjusted. If the curvature of the curve corresponding to the second control point and the target control point in the generated curve path is greater than the preset curvature threshold, the curve path may be adjusted by adding a control point between the fifth control point and the second control point (such as Figure 14-16 As shown, one or more control points can be added in the middle of the line segment DC to obtain a spline with a higher order, generating a curve path that is closer to the line segment DC and has a smaller curvature at the end of the curve corresponding to the line segment CQ. The example of adding one control point in the figure uses the existing point E) to further adjust the generated curve path until the curvature of the curve corresponding to the second control point and the target control point in the curvature path of the autonomous mobile device is less than or equal to the preset curvature threshold.
[0092] Specifically, the first curvature of the curve corresponding to the second control point and the target control point in the generated curve path can be calculated. When the first curvature is less than or equal to the preset curvature threshold, the generated curve path is not adjusted. When the first curvature is greater than the preset curvature threshold, a control point is added between the fifth control point and the second control point, and the curve path of the autonomous mobile device is regenerated according to the fifth control point, the added control point, the second control point and the target control point, and the added control point can directly use the sixth control point. The second curvature of the curve corresponding to the second control point and the target control point in the regenerated curve path is calculated. When the second curvature is less than or equal to the preset curvature threshold, the curve path is no longer adjusted. When the second curvature is greater than the preset curvature threshold, the step of "adding a control point between the fifth control point and the second control point, and regenerating the curve path of the autonomous mobile device according to the added control point, the fifth control point, the second control point and the target control point" is continued until the curvature of the curve corresponding to the second control point and the target control point in the curvature path of the autonomous mobile device is less than or equal to the preset curvature threshold.
[0093] In some embodiments, after the curved path is generated by adopting the third curved path generation strategy, it can be determined whether to further adjust the generated curved path according to whether the curvature of the curve corresponding to the second control point and the target control point in the generated curved path is greater than a preset curvature threshold and whether the number of adjustments of the autonomous mobile device reaches a preset number of adjustments (wherein, each time the autonomous mobile device performs an operation of moving backward and turning at the same time according to the adjustment path generated by the third curved path strategy, it is considered as one adjustment). If the curvature of the curve corresponding to the second control point and the target control point in the generated curved path is less than or equal to the preset curvature threshold, the generated curved path may not be adjusted. If the curvature of the curve corresponding to the second control point and the target control point in the generated curved path is greater than the preset curvature threshold, the third curved path generation strategy can be continued to be adopted to adjust the position of the autonomous mobile device, and the curved path of the autonomous mobile device is regenerated based on the adjusted position until the curvature of the curve corresponding to the second control point and the target control point in the generated curved path is less than or equal to the preset curvature threshold, or the number of adjustments of the autonomous mobile device reaches the preset number of adjustments.
[0094] Specifically, the first curvature of the curve corresponding to the second control point and the target control point in the generated curve path can be calculated. When the first curvature is less than or equal to the preset curvature threshold, the generated curve path is not adjusted. When the first curvature is greater than the preset curvature threshold, the third curve path generation strategy is continued to be used to generate the curve path of the autonomous mobile device until the curvature of the curve corresponding to the second control point and the target control point in the curvature path of the autonomous mobile device is less than or equal to the preset curvature threshold, or the number of adjustments of the autonomous mobile device reaches the preset number of adjustments. It should be noted that if the curve path generated by the autonomous mobile device still does not meet the end point accuracy requirement after the preset number of adjustments (that is, the first curvature is still greater than the preset curvature threshold), a prompt message for requesting manual processing can be issued so that relevant personnel intervene to adjust the autonomous mobile device or directly control the mobile device to move to the end point, so as to avoid the autonomous mobile device spending too much time on autonomous adjustment.
[0095] In some embodiments, when the positional relationship is other than the first positional relationship, the second positional relationship, the third positional relationship, and the fourth positional relationship, the four control points of the starting control point, the first control point, the second control point, and the target control point can be directly used to generate a cubic B-spline curve as the curve path of the autonomous mobile device, or the fourth curve path generation strategy can be used to generate the curve path of the autonomous mobile device.
[0096] The above-mentioned "using the fourth curve path generation strategy to generate a curve path for the autonomous mobile device" may include the following steps: determining a specific control point between the first control point (or the other control points that can be regarded as the first control point) and the second control point (or the other control points that can be regarded as the second control point), the specific control point is located between the first control point and the second control point, and generating a curve path according to the starting control point, the first control point, the specific control point, the second control point and the target control point. For details, please refer to the subsequent step S260.
[0097] The path planning method provided in the embodiment of the present application generates a curved path for the autonomous mobile device according to the positional relationship of the starting control point, the target control point, the first control point and the second control point, when the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to the preset angle threshold. This ensures that when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the curve generation strategy corresponding to the positional relationship of the above four control points can be used to generate the curved path for the autonomous mobile device, thereby solving the problem that the current curved path generation method cannot generate a curved path for the autonomous mobile device that meets the control accuracy of the end point when the distance between the autonomous mobile device and the target is too close and / or the angle is too large. In addition, since the path planning method provided in the embodiment of the present application can generate a curved path when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, no manual intervention is required, and the autonomous mobile device does not need to have the function of supporting rotation in situ, the cost is low and the mobility efficiency of the autonomous mobile device during the entire movement process can be improved.
[0098] Fig.17 A schematic flow chart of a path planning method provided by an embodiment of the present application is shown. The path planning method can be applied to a path planning device or an autonomous mobile device. The path planning method can include the following steps S210 to S250.
[0099] Step S210, obtaining the current posture and target posture of the autonomous mobile device.
[0100] The current posture of the autonomous mobile device can be acquired in real time through the sensing device on the autonomous mobile device, and the target posture of the autonomous mobile device predetermined and stored based on the target corresponding to the autonomous mobile device can be acquired. For the specific description, please refer to the relevant parts in the aforementioned embodiments, which will not be repeated here.
[0101] Step S220 , judging whether the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold according to the current position of the autonomous mobile device and the target position.
[0102] When the distance between the position in the current posture and the position in the target posture is less than or equal to the preset distance threshold, it is determined that the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold.
[0103] When the distance between the position in the current posture and the position in the target posture is greater than the preset distance threshold, it is determined that the distance between the autonomous mobile device and the target is greater than the preset distance threshold.
[0104] Step S230 , judging whether the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold according to the current position and position of the autonomous mobile device and the target position.
[0105] When the angle between the posture in the current posture and the posture in the target posture is greater than or equal to a preset angle threshold, it is determined that the angle between the autonomous mobile device and the target is greater than or equal to the preset angle threshold.
[0106] When the angle between the posture in the current posture and the posture in the target posture is less than the preset angle threshold, it is determined that the angle between the autonomous mobile device and the target is less than the preset angle threshold.
[0107] Step S240, when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, obtain a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path for the autonomous mobile device, wherein the second control point is closer to the target control point than the first control point; determine the positional relationship between the starting control point, the target control point, the first control point, and the second control point; and generate a curved path for the autonomous mobile device using a curved path generation strategy corresponding to the positional relationship, wherein the curved path generation strategy corresponding to the positional relationship includes at least one of a first curved path generation strategy, a second curved path generation strategy, a third curved path generation strategy, a fourth curved path generation strategy, and directly using four control points to generate a cubic B-spline curve.
[0108] The specific description of step S240 can be found in the aforementioned steps S110 to S130 , which will not be repeated here.
[0109] Step S250, when the distance between the autonomous mobile device and the target is greater than a preset distance threshold, and the angle between the autonomous mobile device and the target is less than a preset angle threshold, a cubic B-spline curve is generated as the curve path of the autonomous mobile device according to the starting control point, the first control point, the second control point and the target control point, or a fourth curve path generation strategy is used to generate the curve path of the autonomous mobile device.
[0110] When the distance between the autonomous mobile device and the target is greater than the preset distance threshold, and the angle between the autonomous mobile device and the target is less than the preset angle threshold, it means that the autonomous mobile device is currently far away from the target and the angle is small. At this time, using the original four control points as input parameters of the cubic B-spline curve to generate the curve path of the autonomous mobile device can meet the movement requirements of the autonomous mobile device.
[0111] In some embodiments, the fourth curved path generation strategy is adopted to generate a curved path of the autonomous mobile device, which may include the following steps: determining a specific control point between the first control point (or other control points that can be regarded as the first control point) and the second control point (or other control points that can be regarded as the second control point); and generating a curved path using a B-spline curve interpolation method according to the starting control point, the first control point, the specific control point, the second control point, and the target control point. The specific control point may be located on a straight line between the second control point and the target control point.
[0112] In some embodiments, the ratio between the distance between the starting control point and the first control point and the distance between the starting control point and the target control point can be calculated as the first ratio; the ratio between the distance between the specific control point and the target control point and the distance between the starting control point and the target control point can be calculated as the second ratio; and a number of points whose sum of the first ratio and the second ratio is less than 1 are the specific control points. By calculating the first ratio and the second ratio, and requiring the sum of the first ratio and the second ratio to be less than 1, the position of the specific control point can be narrowed and optimized. Among them, the path with the largest sum of the first ratio and the second ratio is the curved path. In some embodiments, the first ratio is greater than 10% and less than 40%, and / or the second ratio is greater than 10% and less than 40%.
[0113] In some implementations, the ratio between the distance between the second control point and the target control point and the distance between the start control point and the target control point can also be calculated as a third ratio, requiring the sum of the first ratio and the second ratio to be less than 1, and the third ratio to be less than the second ratio, which can further reduce the control error and optimize the position of the control point. In some implementations, the third ratio can be less than or equal to half of the second ratio.
[0114] For the parts not described in detail in the method of generating a curved path using the fourth curved path generation strategy, please refer to the relevant technology and will not be described in detail here.
[0115] The path planning method provided in the embodiment of the present application can use the fourth curve path generation strategy to generate the curve path of the autonomous mobile device when the distance between the autonomous mobile device and the target is far and the angle is small. When the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the curve path generation strategy corresponding to the positional relationship between the starting control point, the first control point, the second control point and the target control point can be used to generate the curve path of the autonomous mobile device, thereby ensuring that the autonomous mobile device can generate the curve path by itself in various situations. The problem that the current curve path generation method cannot generate the curve path of the autonomous mobile device when the distance between the autonomous mobile device and the target is too close and / or the angle is too large can be solved. In addition, since the path planning method provided in the embodiment of the present application can generate the curve path when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, there is no need for manual intervention, and the autonomous mobile device does not need to have the function of supporting rotation in situ, the cost is low and the mobility efficiency of the autonomous mobile device during the entire movement process can be improved.
[0116] Fig.18 The schematic diagram of the structure of the path planning device provided in the embodiment of the present application is shown. The path planning device 100 can be applied to an autonomous mobile device. The path planning device 100 can include a data acquisition module 110, a data processing module 120 and a path planning module 130.
[0117] The data acquisition module 110 is used to acquire a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of an autonomous mobile device, wherein the second control point is closer to the target control point than the first control point.
[0118] The data processing module 120 is used to determine the positional relationship between the starting control point, the target control point, the first control point and the second control point when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold.
[0119] The path planning module 130 is used to generate a curved path for the autonomous mobile device by adopting a curved path generation strategy corresponding to the position relationship.
[0120] In some embodiments, the data acquisition module 110 is further used to obtain the current posture and target posture of the autonomous mobile device before obtaining the starting control point, the target control point, the first control point between the starting control point and the target control point, and the second control point used to generate the curved path of the autonomous mobile device; and determine that the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold when the distance between the position in the current posture and the position in the target posture is less than or equal to the preset distance threshold.
[0121] In some embodiments, the data acquisition module 110 is also used to determine that the angle of the autonomous mobile device from the target is greater than or equal to the preset angle threshold before determining the positional relationship between the starting control point, the target control point, the first control point, and the second control point when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, and when the angle between the posture in the current posture and the posture in the target posture is greater than or equal to the preset angle threshold.
[0122] In some embodiments, the path planning module 130 is also used to generate a curved path for the autonomous mobile device by adopting one of a first curved path generation strategy, a second curved path generation strategy, and a third curved path generation strategy when the position relationship is a first position relationship, wherein the first position relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point intersects the straight line where the target control point and the second control point are located, and the intersection point of the line segment formed by the starting control point and the first control point and the straight line where the target control point and the second control point are located is not the starting control point and the first control point.
[0123] In some embodiments, the path planning module 130 is also used to obtain the current surrounding environment information of the autonomous mobile device when the position relationship is the first position relationship; and based on the surrounding environment information, one of the first curve path generation strategy, the second curve path generation strategy and the third curve path generation strategy is adopted to generate a curve path for the autonomous mobile device.
[0124] In some embodiments, the path planning module 130 is further configured to generate a curved path for the autonomous mobile device using the first curved path generation strategy when it is determined based on the surrounding environment information that there is no adjustment space for the autonomous mobile device to move backward.
[0125] In some embodiments, the path planning module 130 is also used to determine the intersection of the straight line where the starting control point and the first control point are located and the straight line where the target control point and the second control point are located; based on the intersection, the starting control point, the second control point and the target control point, generate a curved path for the autonomous mobile device.
[0126] In some embodiments, the path planning module 130 is further used to generate a curved path for the autonomous mobile device by using one of the first curve generation strategy and the second curve path generation strategy when it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn.
[0127] In some embodiments, the path planning module 130 is further used to generate a curved path for the autonomous mobile device by using one of the first curved path generation strategy, the second curved path generation strategy, and the third curved path generation strategy when it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn.
[0128] In some embodiments, the path planning module 130 is further used to generate a curved path for the autonomous mobile device by using one of a second curved path generation strategy and a third curved path generation strategy when the position relationship is a second position relationship or a third position relationship, wherein the second position relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point does not intersect the straight line where the target control point and the second control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is less than the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the straight line where the target control point and the second control point are located is greater than the distance from the starting control point to the straight line where the target control point and the second control point are located, and the third position relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point intersects the straight line where the target control point and the second control point are located at the starting control point.
[0129] In some embodiments, the path planning module 130 is also used to obtain the current surrounding environment information of the autonomous mobile device when the position relationship is the second position relationship or the third position relationship; based on the surrounding environment information, one of the second curve path generation strategy and the third curve path generation strategy is adopted to generate the curve path of the autonomous mobile device.
[0130] In some embodiments, the path planning module 130 is further used to generate a curved path for the autonomous mobile device using the second curved path generation strategy when it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn.
[0131] In some embodiments, the path planning module 130 is further used to generate a curved path for the autonomous mobile device by using one of the second curved path generation strategy and the third curved path generation strategy when it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn.
[0132] In some embodiments, the path planning module 130 is also used to generate a curved path for the autonomous mobile device by adopting a third curved path generation strategy when the position relationship is a fourth position relationship, wherein the fourth position relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is greater than or equal to the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the straight line where the second control point and the target control point are located is less than or equal to the distance from the starting control point to the straight line where the second control point and the target control point are located.
[0133] In some embodiments, the path planning module 130 determines the intersection of the straight line where the starting control point and the first control point are located and the straight line where the second control point and the target control point are located; determines a third control point on the ray formed by the first control point as the endpoint and passing through the starting control point, and the third control point is farther away from the starting control point than the intersection point; determines a fourth control point on the line segment formed by the intersection and the third control point, and the fourth control point is not the third control point; generates an adjustment path for the autonomous mobile device based on the starting control point and the third control point, and generates a curved path for the autonomous mobile device based on the third control point, the fourth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path to the position corresponding to the third control point, and the autonomous mobile device moves along the curved path from the position corresponding to the third control point to the position corresponding to the target control point.
[0134] In some implementations, the fourth control point is the intersection point.
[0135] In some embodiments, the path planning module 130 is further used to determine a fifth control point on a ray formed by passing through the starting control point with the second control point as an endpoint, the fifth control point being farther from the first control point than the starting control point; to determine a sixth control point on a line segment formed by the starting control point and the fifth control point; to determine a seventh control point on a ray passing through the starting control point with the first control point as an endpoint, the seventh control point being farther from the first control point than the starting control point; to generate an adjustment path based on the starting control point, the seventh control point, the sixth control point and the fifth control point, and to generate a curved path for the autonomous mobile device based on the fifth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path and turns to the position corresponding to the fifth control point at the same time, and the autonomous mobile device moves along the curved path from the position corresponding to the fifth control point to the position corresponding to the target control point.
[0136] In some implementations, an angle formed by the starting control point, the seventh control point, and the sixth control point with the seventh control point as the vertex is an obtuse angle.
[0137] In some embodiments, the path planning module 130 is further used to calculate the first curvature of the curve corresponding to the second control point and the target control point in the generated curved path after the curved path of the autonomous mobile device is generated according to the fifth control point, the second control point and the target control point; when the first curvature is greater than a preset curvature threshold, add a control point between the fifth control point and the second control point, and regenerate the curved path of the autonomous mobile device according to the added control point, the fifth control point, the second control point and the target control point, and the added control point may use the sixth control point; calculate the second curvature of the curve corresponding to the second control point and the target control point in the regenerated curved path; when the second curvature is greater than the preset curvature threshold, continue to perform the steps of adding a control point between the fifth control point and the second control point, and regenerate the curved path of the autonomous mobile device according to the added control point, the fifth control point, the second control point and the target control point, until the curvature of the curve corresponding to the second control point and the target control point in the curvature path of the autonomous mobile device is less than or equal to the preset curvature threshold.
[0138] In some embodiments, the path planning module 130 is also used to calculate the first curvature of the curve corresponding to the second control point and the target control point in the generated curved path after the curved path of the autonomous mobile device is generated according to the fifth control point, the second control point and the target control point; when the first curvature is greater than a preset curvature threshold, continue to execute the step of determining the fifth control point on the ray formed by the second control point as the endpoint and passing through the starting control point, the fifth control point being farther from the first control point than the starting control point, until the curvature of the curve corresponding to the second control point and the target control point in the curvature path of the autonomous mobile device is less than or equal to the preset curvature threshold, or the number of adjustments of the autonomous mobile device reaches a preset number of adjustments, wherein executing the step of determining the fifth control point on the ray formed by the second control point as the endpoint and passing through the starting control point once, the fifth control point being farther from the first control point than the starting control point is one adjustment.
[0139] In some embodiments, the path planning module 130 is also used to generate a cubic B-spline curve as the curved path of the autonomous mobile device according to the starting control point, the first control point, the second control point and the target control point when the position relationship is other than the first position relationship, the second position relationship, the third position relationship and the fourth position relationship, or to generate the curved path of the autonomous mobile device using the fourth curved path generation strategy.
[0140] In some embodiments, the path planning module 130 is further used to generate a cubic B-spline curve as the curved path of the autonomous mobile device according to the starting control point, the first control point, the second control point and the target control point, or to generate the curved path of the autonomous mobile device using the fourth curved path generation strategy, when the distance between the autonomous mobile device and the target is greater than the preset distance threshold and the angle between the autonomous mobile device and the target is less than the preset angle threshold.
[0141] Those skilled in the art can clearly understand that the path planning device 100 provided in the embodiment of the present application can implement the path planning method provided in the embodiment of the present application. The specific working process of the above-mentioned device and module can refer to the corresponding process of the path planning method in the embodiment of the present application, which will not be repeated here.
[0142] In the embodiments provided in the present application, the coupling, direct coupling or communication connection between the modules shown or discussed may be indirect coupling or communication coupling through some interfaces, devices or modules, and may be electrical, mechanical or other forms, and the embodiments of the present application are not limited to this.
[0143] In addition, each functional module in the embodiment of the present application can be integrated into one processing module, or each module can exist physically separately, or two or more modules can be integrated into one module. The above integrated modules can be implemented in the form of hardware or in the form of software functional modules, which is not limited in the embodiment of the present application.
[0144] Fig.19 The schematic diagram of the structure of the autonomous mobile device provided by the embodiment of the present application is shown. The autonomous mobile device 200 may include one or more of the following components: a memory 210, one or more processors 220, and one or more applications, wherein the one or more applications may be stored in the memory 210 and configured to, when called by the one or more processors 220, enable the one or more processors 220 to execute the above-mentioned path planning method provided by the embodiment of the present application. The autonomous mobile device 200 may include, but is not limited to, AMR, AGV, and unmanned forklift, etc.
[0145] The processor 220 may include one or more processing cores. The processor 220 uses various interfaces and lines to connect various parts of the entire autonomous mobile device 200, and is used to run or execute instructions, programs, code sets or instruction sets stored in the memory 210, and call to run or execute data stored in the memory 210, perform various functions of the autonomous mobile device 200, and process data.
[0146] The processor 220 can be implemented in at least one of the following hardware forms: digital signal processing (DSP), field programmable gate array (FPGA), and programmable logic array (PLA). The processor 220 can integrate one or a combination of a central processing unit (CPU), a graphics processing unit (GPU), and a modem. Among them, the CPU mainly processes the operating system, user interface, and application programs; the GPU is responsible for rendering and drawing display content; and the modem is used to process wireless communications. It is understandable that the above-mentioned modem may not be integrated into the processor 220, but may be implemented separately through a communication chip.
[0147] The memory 210 may include a random access memory (RAM) or a read-only memory (ROM). The memory 210 may be used to store instructions, programs, codes, code sets or instruction sets. The memory 210 may include a program storage area and a data storage area. The program storage area may store instructions for implementing an operating system, instructions for implementing at least one function, instructions for implementing the above-mentioned various method embodiments, etc. The data storage area may store data created by the autonomous mobile device 200 during use and various preset thresholds, etc.
[0148] Fig. 20 The computer-readable storage medium 300 stores a program code 310, which is configured to cause the processor to execute the path planning method provided in the embodiment of the present application when called by the processor.
[0149] The computer-readable storage medium 300 may be an electronic storage such as a flash memory, an electrically erasable programmable read-only memory (EEPROM), an erasable programmable read-only memory (EPROM), a hard disk or a ROM.
[0150] In some embodiments, the computer readable storage medium 300 includes a non-transitory computer readable medium (Non-TCRSM). The computer readable storage medium 300 has storage space for program codes 310 that execute any method steps in the above method. These program codes 310 can be read from or written into one or more computer program products. The program codes 310 can be compressed in an appropriate form.
[0151] The path planning method, device, autonomous mobile device and storage medium provided by the embodiment of the present application, when the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to the preset angle threshold, according to the positional relationship between the starting control point, the target control point, the first control point and the second control point, a curve path generation strategy corresponding to the positional relationship is used to generate the curve path of the autonomous mobile device, which can ensure that when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, the curve generation strategy corresponding to the positional relationship of the above four control points can be used to generate the curve path of the autonomous mobile device, thereby solving the problem that the current curve path generation method cannot generate a curve path of the autonomous mobile device that meets the control accuracy of the end point when the distance between the autonomous mobile device and the target is too close and / or the angle is too large. In addition, since the path planning method provided by the embodiment of the present application can generate a curve path when the distance between the autonomous mobile device and the target is too close and / or the angle is too large, no manual intervention is required, and the autonomous mobile device does not need to have the function of supporting rotation in situ, the cost is low and the mobility efficiency of the autonomous mobile device during the entire movement process can be improved.
[0152] Finally, it should be noted that 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 above embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the above embodiments, or replace some of the technical features therein by equivalents; and these modifications or replacements do not drive the essence of the corresponding technical solutions out of the spirit and scope of the technical solutions of the embodiments of the present application.
Claims
1. A path planning method, characterized in that: include: Acquire a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of an autonomous mobile device, wherein the second control point is closer to the target control point than the first control point; When the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, determining the positional relationship between the starting control point, the target control point, the first control point, and the second control point; A curved path generation strategy corresponding to the positional relationship is adopted to generate a curved path for the autonomous mobile device.
2. The method according to claim 1, characterized in that: Before acquiring a starting control point, a target control point, a first control point and a second control point located between the starting control point and the target control point for generating a curved path of the autonomous mobile device, the method further includes: Acquire the current position and target position of the autonomous mobile device; When the distance between the position in the current posture and the position in the target posture is less than or equal to the preset distance threshold, it is determined that the distance between the autonomous mobile device and the target is less than or equal to the preset distance threshold.
3. The method according to claim 1 or 2, characterized in that: In the case where the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold, before determining the positional relationship between the starting control point, the target control point, the first control point, and the second control point, the method further includes: When the angle between the posture in the current posture and the posture in the target posture is greater than or equal to the preset angle threshold, it is determined that the angle between the autonomous mobile device and the target is greater than or equal to the preset angle threshold.
4. The method according to claim 1, characterized in that: The step of adopting a curved path generation strategy corresponding to the positional relationship to generate a curved path for the autonomous mobile device includes: When the positional relationship is the first positional relationship, one of the first curve path generation strategy, the second curve path generation strategy, and the third curve path generation strategy is adopted to generate the curve path of the autonomous mobile device, wherein the first positional relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point intersects the straight line where the target control point and the second control point are located, and the intersection point of the line segment formed by the starting control point and the first control point and the straight line where the target control point and the second control point are located is not the starting control point and the first control point.
5. The method according to claim 4, characterized in that When the position relationship is the first position relationship, one of the first curved path generation strategy, the second curved path generation strategy, and the third curved path generation strategy is adopted to generate the curved path of the autonomous mobile device, including: When the positional relationship is the first positional relationship, obtaining current surrounding environment information of the autonomous mobile device; According to the surrounding environment information, one of the first curved path generation strategy, the second curved path generation strategy and the third curved path generation strategy is adopted to generate a curved path of the autonomous mobile device.
6. The method according to claim 5, characterized in that The step of generating the curved path of the autonomous mobile device according to the surrounding environment information by using one of the first curved path generation strategy, the second curved path generation strategy, and the third curved path generation strategy includes: When it is determined according to the surrounding environment information that there is no adjustment space for the autonomous mobile device to move backward, the first curved path generation strategy is adopted to generate a curved path for the autonomous mobile device.
7. The method according to claim 6, characterized in that The step of adopting the first curved path generation strategy to generate the curved path of the autonomous mobile device includes: Determine an intersection point between a line segment where the starting control point and the first control point are located and a straight line where the target control point and the second control point are located; A curved path of the autonomous mobile device is generated based on the intersection point, the starting control point, the second control point, and the target control point.
8. The method according to claim 5, characterized in that The step of generating the curved path of the autonomous mobile device according to the surrounding environment information by using one of the first curved path generation strategy, the second curved path generation strategy and the third curved path generation strategy further includes: When it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn, one of the first curve generation strategy and the second curve path generation strategy is adopted to generate a curve path for the autonomous mobile device.
9. The method according to claim 5, characterized in that The step of generating the curved path of the autonomous mobile device according to the surrounding environment information by using one of the first curved path generation strategy, the second curved path generation strategy and the third curved path generation strategy further includes: When it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn, one of the first curve path generation strategy, the second curve path generation strategy and the third curve path generation strategy is adopted to generate a curve path for the autonomous mobile device.
10. The method according to claim 1, characterized in that The step of generating the curved path of the autonomous mobile device by using a curved path generation strategy corresponding to the positional relationship further includes: In the case where the positional relationship is the second positional relationship or the third positional relationship, one of the second curve path generation strategy and the third curve path generation strategy is adopted to generate the curve path of the autonomous mobile device, wherein the second positional relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point does not intersect the straight line where the target control point and the second control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is less than the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the straight line where the target control point and the second control point are located is greater than the distance from the starting control point to the straight line where the target control point and the second control point are located, and the third positional relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the line segment formed by the starting control point and the first control point and the straight line where the target control point and the second control point are located intersect at the starting control point.
11. The method according to claim 10, characterized in that When the position relationship is the second position relationship or the third position relationship, one of the second curved path generation strategy and the third curved path generation strategy is adopted to generate the curved path of the autonomous mobile device, including: When the positional relationship is the second positional relationship or the third positional relationship, obtaining current surrounding environment information of the autonomous mobile device; According to the surrounding environment information, one of the second curved path generation strategy and the third curved path generation strategy is adopted to generate a curved path for the autonomous mobile device.
12. The method according to claim 11, characterized in that The adopting one of the second curved path generation strategy and the third curved path generation strategy to generate the curved path of the autonomous mobile device includes: When it is determined according to the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and there is no adjustment space for the autonomous mobile device to turn, the second curved path generation strategy is adopted to generate a curved path for the autonomous mobile device.
13. The method according to claim 11, characterized in that The step of using one of the second curved path generation strategy and the third curved path generation strategy to generate the curved path of the autonomous mobile device further includes: When it is determined based on the surrounding environment information that there is adjustment space for the autonomous mobile device to move backward and turn, one of the second curved path generation strategy and the third curved path generation strategy is adopted to generate a curved path for the autonomous mobile device.
14. The method according to claim 1, characterized in that The step of generating the curved path of the autonomous mobile device by using a curved path generation strategy corresponding to the positional relationship further includes: When the positional relationship is the fourth positional relationship, the third curve path generation strategy is adopted to generate the curve path of the autonomous mobile device, wherein the fourth positional relationship is that the second control point and the target control point are located on the same side of the straight line where the starting control point and the first control point are located, and the distance from the second control point to the straight line where the starting control point and the first control point are located is greater than or equal to the distance from the target control point to the straight line where the starting control point and the first control point are located, and the distance from the first control point to the straight line where the second control point and the target control point are located is less than or equal to the distance from the starting control point to the straight line where the second control point and the target control point are located.
15. The method according to claim 8 or 12, characterized in that: The step of adopting the second curved path generation strategy to generate the curved path of the autonomous mobile device includes: Determine an intersection point between a straight line where the starting control point and the first control point are located and a straight line where the second control point and the target control point are located; Determine a third control point on a ray formed by taking the first control point as an endpoint and passing through the starting control point, wherein the third control point is farther from the starting control point than the intersection point; determine a fourth control point on a line segment formed by the intersection point and the third control point, wherein the fourth control point is not the third control point; An adjustment path of the autonomous mobile device is generated based on the starting control point and the third control point, and a curved path of the autonomous mobile device is generated based on the third control point, the fourth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path to a position corresponding to the third control point, and the autonomous mobile device moves along the curved path from the position corresponding to the third control point to a position corresponding to the target control point.
16. The method according to claim 15, characterized in that The fourth control point is the intersection point.
17. The method according to any one of claims 9, 13 and 14, characterized in that: The step of adopting the third curved path generation strategy to generate the curved path of the autonomous mobile device includes: Determine a fifth control point on a ray formed by taking the second control point as an endpoint and passing through the starting control point, wherein the fifth control point is farther from the first control point than the starting control point; Determine a sixth control point on a line segment formed by the starting control point and the fifth control point; Determine a seventh control point on a ray that takes the first control point as an endpoint and passes through the starting control point, wherein the seventh control point is farther from the first control point than the starting control point; An adjustment path is generated based on the starting control point, the seventh control point, the sixth control point and the fifth control point, and a curved path of the autonomous mobile device is generated based on the fifth control point, the second control point and the target control point, wherein the autonomous mobile device moves backward along the adjustment path and turns to the position corresponding to the fifth control point at the same time, and the autonomous mobile device moves along the curved path from the position corresponding to the fifth control point to the position corresponding to the target control point.
18. The method according to claim 17, characterized in that The angle formed by the starting control point, the seventh control point and the sixth control point with the seventh control point as the vertex is an obtuse angle.
19. The method according to claim 17, characterized in that After generating the curved path of the autonomous mobile device according to the fifth control point, the second control point and the target control point, the method further includes: Calculating a first curvature of a curve corresponding to the second control point and the target control point in the generated curve path; When the first curvature is greater than a preset curvature threshold, adding a control point between the fifth control point and the second control point, and regenerating the curved path of the autonomous mobile device according to the added control point, the fifth control point, the second control point and the target control point, wherein the added control point includes the sixth control point; Calculating a second curvature of the curve corresponding to the second control point and the target control point in the regenerated curve path; When the second curvature is greater than the preset curvature threshold, continue to execute the step of adding a new control point between the fifth control point and the second control point, and regenerate the curved path of the autonomous mobile device according to the newly added control point, the fifth control point, the second control point and the target control point, until the curvature of the curve corresponding to the second control point and the target control point in the curved path of the autonomous mobile device is less than or equal to the preset curvature threshold.
20. The method according to claim 17, characterized in that After generating the curved path of the autonomous mobile device according to the fifth control point, the second control point and the target control point, the method further includes: Calculating a first curvature of a curve corresponding to the second control point and the target control point in the generated curve path; When the first curvature is greater than a preset curvature threshold, continue to execute the step of determining a fifth control point on a ray formed by passing through the starting control point with the second control point as the endpoint, wherein the fifth control point is farther from the first control point than the starting control point, until the curvature of the curve corresponding to the second control point and the target control point in the curved path of the autonomous mobile device is less than or equal to the preset curvature threshold, or the number of adjustments of the autonomous mobile device reaches a preset number of adjustments, wherein each execution of the step of determining a fifth control point on a ray formed by passing through the starting control point with the second control point as the endpoint, wherein the fifth control point is farther from the first control point than the starting control point is an adjustment.
21. The method according to claim 1, characterized in that The step of generating the curved path of the autonomous mobile device by using a curved path generation strategy corresponding to the positional relationship further includes: When the position relationship is other than the first position relationship, the second position relationship, the third position relationship and the fourth position relationship, a curve is generated as the curved path of the autonomous mobile device according to the starting control point, the first control point, the second control point and the target control point, or the fourth curved path generation strategy is used to generate the curved path of the autonomous mobile device.
22. The method according to claim 1, characterized in that After acquiring the starting control point, the target control point, the first control point and the second control point located between the starting control point and the target control point for generating the curved path of the autonomous mobile device, the method further includes: When the distance between the autonomous mobile device and the target is greater than the preset distance threshold and the angle between the autonomous mobile device and the target is less than the preset angle threshold, a curve is generated as the curved path of the autonomous mobile device according to the starting control point, the first control point, the second control point and the target control point, or a fourth curved path generation strategy is used to generate the curved path of the autonomous mobile device.
23. A path planning device, characterized in that: include: a data acquisition module, configured to acquire a starting control point, a target control point, a first control point between the starting control point and the target control point, and a second control point for generating a curved path of an autonomous mobile device, wherein the second control point is closer to the target control point than the first control point; a data processing module, configured to determine a positional relationship between the starting control point, the target control point, the first control point, and the second control point when the distance between the autonomous mobile device and the target is less than or equal to a preset distance threshold, and / or when the angle between the autonomous mobile device and the target is greater than or equal to a preset angle threshold; The path planning module is used to generate a curved path for the autonomous mobile device by adopting a curved path generation strategy corresponding to the position relationship.
24. An autonomous mobile device, characterized in that: include: Memory; one or more processors; One or more applications, the one or more applications are stored on the memory and are used to execute the method according to any one of claims 1-22 when called by the one or more processors.
25. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores program code, and the program code is used to execute the method according to any one of claims 1 to 22 when called by a processor.
