Speed planning method and device, autonomous mobile device and storage medium

By calculating the speed change of the autonomous mobile device and introducing the acceleration, the problem of unstable speed planning and movement of the autonomous mobile device in complex environments is solved, and more flexible and stable movement is achieved.

CN119024823APending Publication Date: 2024-11-26KUKA ROBOTICS GUANGDONG CO LTD
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202310578370.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-05-22
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

Existing autonomous mobile devices have problems with inability to perform real-time speed planning and unstable movement in terms of speed planning, especially in complex environments, where speed is difficult to adjust to meet real-time needs.

Method used

By obtaining the current speed, acceleration, acceleration and preset maximum acceleration of the autonomous mobile device, calculating the velocity change amount, and real-time speed planning based on the velocity change amount and acceleration, the velocity acceleration is introduced to improve movement stability.

Benefits of technology

Real-time speed planning and mobility stability of autonomous mobile devices in complex environments are achieved, and can more flexibly respond to the needs of various scenarios, improving the shortcomings of traditional offline speed planning.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119024823A_ABST
    Figure CN119024823A_ABST
Patent Text Reader

Abstract

The embodiment of the invention provides a speed planning method and device, an autonomous mobile device and a storage medium, and relates to the technical field of autonomous mobile devices. The method comprises the following steps: acquiring a current position, a current speed, a current acceleration, a current jerk, a preset maximum jerk and a preset jerk of the autonomous mobile device; calculating a speed variation according to the current position, the current acceleration, the current jerk, the maximum jerk and the jerk; and according to the current position, the speed variation, the current speed, the current acceleration, the current jerk and the jerk, performing speed planning on the autonomous mobile device, so that the problems of incapability of performing real-time speed planning and unstable movement of the autonomous mobile device in a current speed planning method can be improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] Embodiments of the present application relate to the technical field of autonomous mobile devices, and in particular, to a speed planning method, device, autonomous mobile device, and storage medium. Background Art

[0002] In recent years, autonomous mobile devices such as autonomous mobile robots (AMRs) or automated guided vehicles (AGVs) 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 speed planning method, device, autonomous mobile device and storage medium to improve the problems of the current speed planning method that cannot perform real-time speed planning and the unstable movement of the autonomous mobile device.

[0004] In the first aspect, the embodiment of the present application provides a speed planning method. The method includes: obtaining the current speed, current acceleration, current jerk, a preset maximum jerk and a preset jerk of an autonomous mobile device, wherein the jerk is used to describe the speed of change of acceleration, and the jerk is used to describe the speed of change of jerk; calculating the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk; and performing speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk and the jerk.

[0005] In the second aspect, the embodiment of the present application provides a speed planning device. The device includes: a data acquisition module, which is used to obtain the current speed, current acceleration, current jerk, a preset maximum jerk and a preset jerk of the autonomous mobile device, wherein the jerk is used to describe the speed of change of acceleration, and the jerk is used to describe the speed of change of jerk; a data processing module, which is used to calculate the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk; a speed planning module, which is used to perform speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk and the jerk.

[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 speed planning method, device, autonomous mobile device and storage medium provided in the embodiments of the present application can calculate the speed change according to the current position, current acceleration, current jerk, a preset maximum jerk and a preset jerk of the autonomous mobile device, and perform speed planning for the autonomous mobile device according to the current position, speed change, current speed, current acceleration, current jerk and jerk of the autonomous mobile device, thereby performing real-time speed planning. In addition, the embodiments of the present application introduce a jerk for describing the speed of jerk change, and set the jerk to a preset fixed value, which can improve the stability of the autonomous mobile device during movement, thereby improving the problems of the current speed planning method that cannot perform real-time speed planning and the unstable movement of the autonomous mobile device. 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 It is a structural schematic diagram of a speed planning system provided in an embodiment of the present application;

[0011] Figure 2 It is a flow chart of a speed planning method provided in one embodiment of the present application;

[0012] Figure 3 is a schematic diagram of an acceleration interval corresponding to a current acceleration of an autonomous mobile device provided by an exemplary embodiment of the present application;

[0013] Figure 4 is a schematic diagram of a change in jerk of an autonomous mobile device in an acceleration sub-phase provided by an exemplary embodiment of the present application;

[0014] Figure 5is a schematic diagram of a change in jerk of an autonomous mobile device in an acceleration sub-phase provided by another exemplary embodiment of the present application;

[0015] Figure 6 is a schematic diagram of a change in jerk of an autonomous mobile device in an acceleration sub-phase provided by another exemplary embodiment of the present application;

[0016] Figure 7 It is a flow chart of the jerk adjustment strategy in the speed planning method provided in the embodiment of the present application;

[0017] Figure 8 is a flow chart of a speed planning method provided by another embodiment of the present application;

[0018] Fig. 9 is a flow chart of a speed planning method provided by another embodiment of the present application;

[0019] Fig.10 is a schematic diagram of a speed change of an autonomous mobile device in an acceleration phase provided by an exemplary embodiment of the present application;

[0020] Fig.11 is a schematic diagram of a change in jerk of an autonomous mobile device in a deceleration sub-phase provided by an exemplary embodiment of the present application;

[0021] Fig.12 is a schematic diagram of a change in jerk of an autonomous mobile device in a deceleration sub-phase provided by another exemplary embodiment of the present application;

[0022] Fig.13 is a schematic diagram of a change in jerk of an autonomous mobile device in a deceleration sub-phase provided by another exemplary embodiment of the present application;

[0023] Fig.14 is a schematic diagram of a speed change of an autonomous mobile device in a deceleration stage provided by an exemplary embodiment of the present application;

[0024] Fig.15 is a schematic diagram of a speed range corresponding to a second speed provided by an exemplary embodiment of the present application;

[0025] Fig.16 is a flow chart of a speed planning method provided in yet another embodiment of the present application;

[0026] Fig.17 It is a structural schematic diagram of a speed planning device provided in an embodiment of the present application;

[0027] Fig.18 is a schematic diagram of the structure of an autonomous mobile device provided in an embodiment of the present application;

[0028] Fig.19 It is a schematic diagram of the structure of the computer-readable storage medium provided in an embodiment of the present application. DETAILED DESCRIPTION

[0029] 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.

[0030] Current autonomous mobile devices usually use an offline speed planning method to plan the speed of the autonomous mobile device. That is, before the autonomous mobile device moves, a path is given to the autonomous mobile device, and the speed values ​​corresponding to each trajectory point on the path are calculated in advance, so that the autonomous mobile device can move according to the pre-calculated speed values ​​of each trajectory point until it completes the path and reaches the target point. Since this offline speed planning method calculates the speed in advance, it is not possible to perform real-time speed planning and adjust the speed according to the real-time situation. It is not flexible enough and difficult to cope with the increasingly complex scenarios in actual applications. For example, when the surrounding environment of the autonomous mobile device is complex, the speed of the autonomous mobile device is often required to be smaller. In the offline speed planning method, since the speed is calculated in advance, the speed cannot be adjusted according to the actual environment, resulting in difficulty in coping with the complex surrounding environment of the autonomous mobile device.

[0031] In order for the autonomous mobile device to cope with the increasingly complex scenarios in practical applications, the relevant technology proposes a real-time speed planning method, that is, the autonomous mobile device can calculate the speed of the next moment in real time according to the actual state during the movement, and adjust the acceleration according to a fixed jerk. However, the inventors found in their research that although this real-time speed planning method can calculate the speed and adjust the acceleration in real time, the speed is a quadratic polynomial with respect to time, and the jerk is a constant value that switches back and forth between positive and negative signs, which will cause the autonomous mobile device to move unsteadily.

[0032] Based on this, the inventors, after long-term research and discovery, proposed the speed planning method, device, autonomous mobile device and storage medium provided in the embodiments of the present application. The speed change can be calculated according to the current acceleration, the current jerk, the pre-set maximum jerk and the pre-set jerk, and the speed of the autonomous mobile device can be planned according to the speed change, the current speed, the current acceleration, the current jerk and the jerk, so that real-time speed planning can be performed. In addition, the embodiments of the present application introduce the jerk for describing the speed of jerk change, and set the jerk to a pre-set fixed value, which can improve the stability of the autonomous mobile device during movement, thereby improving the problems of the current speed planning method that cannot perform real-time speed planning and the unstable movement of the autonomous mobile device.

[0033] Figure 1 Schematic diagram of the speed planning system provided in the embodiment of the present application. Figure 1 As shown, the speed planning system 100 may include a sensor 110, a speed planning and strategy selector 120, and a controller 130 that can communicate with each other. The sensor 110 can be used to sense the surrounding environment information of the autonomous mobile device so as to obtain the speed limit of the autonomous mobile device. The sensor 110 may include multiple sensors, and the types of the multiple sensors may be the same or different. The multiple sensors may include but are not limited to cameras, laser radar sensors, ultra-wideband sensors, millimeter wave radar sensors, etc. The speed planning and strategy selector 120 can be used to adopt the speed planning method provided in the embodiment of the present application to perform real-time speed planning on the autonomous mobile device, and transmit the speed planning results, such as the next speed, to the controller 130. The controller 130 can control the autonomous mobile device to move according to the speed planning results, such as the next speed. The autonomous mobile device in the embodiment of the present application may refer to a robot or vehicle with autonomous mobile function. For example, the autonomous mobile device may include but is not limited to AMR and AGV.

[0034] Figure 2 1 is a flow chart of a speed planning method provided by an embodiment of the present application. The speed planning method can be applied to a speed planning system (or a speed planning and strategy selector therein) or a speed planning device or an autonomous mobile device. The speed planning method can include the following steps S110 to S130.

[0035] Step S110 , obtaining the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device.

[0036] Among them, acceleration is used to describe the speed of change of speed. Jerk is used to describe the speed of change of acceleration, and jerk is used to describe the speed of change of jerk. It should be noted that the jerk in the embodiment of the present application increases or decreases according to the pre-set jerk each time, and the maximum value of the jerk is less than or equal to the pre-set maximum jerk.

[0037] When the speed planning function is started, the preset maximum jerk and the preset jerk can be obtained, and the current speed, current acceleration and current jerk of the autonomous mobile device can be obtained in real time. When the autonomous mobile device receives the instruction to start the speed planning function sent by the server, the speed planning function can be started.

[0038] Step S120, calculating the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0039] The first acceleration threshold may be calculated according to the current jerk and the jerk; the second acceleration threshold may be calculated according to the current jerk, the maximum jerk and the jerk; the speed change may be calculated according to the first acceleration threshold, the second acceleration threshold, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk. The speed change may refer to the change in speed of the autonomous mobile device during the process of decreasing the current acceleration to 0.

[0040] For example, the following expression may be used to calculate the first acceleration threshold according to the current jerk and the jerk:

[0041]

[0042] Wherein, A1 represents the first acceleration threshold, j0 represents the current jerk, and k represents the jerk.

[0043] For example, the following expression may be used to calculate the second acceleration threshold according to the maximum jerk, the jerk, and the current jerk:

[0044]

[0045] Wherein, A2 represents the second acceleration threshold; j max represents the maximum jerk, j0 represents the current jerk, and k represents the jerk.

[0046] The inventors have found in their long-term research that, for different current acceleration values ​​of the autonomous mobile device, the acceleration changes of the autonomous mobile device are different during the process of the acceleration of the autonomous mobile device decreasing to 0. Figure 3 As shown, the acceleration change of the autonomous mobile device may include the following three situations:

[0047] like Figure 4 In the first case shown in FIG. 1 , when the current acceleration of the autonomous mobile device is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero, during the process of the acceleration of the autonomous mobile device decreasing to 0, the jerk change of the autonomous mobile device may be as follows: Figure 4 That is, the autonomous mobile device first takes time T1 to decrease from the current jerk j0 to 0 in the positive direction (positive direction may refer to the same direction as the initial speed of the autonomous mobile device), and then increases in the reverse direction (reverse direction may refer to the opposite direction to the initial speed of the autonomous mobile device) to the maximum jerk jmax , and then it takes time T2 to go from the maximum jerk j max Reverse direction to reduce to 0.

[0048] like Figure 5 In the second case shown in FIG. 1 , when the current acceleration of the autonomous mobile device is greater than the second acceleration threshold, during the process of the acceleration of the autonomous mobile device decreasing to 0, the acceleration change of the autonomous mobile device may be as follows: Figure 5 That is, the autonomous mobile device first takes time T1 to decrease from the current jerk j0 to 0 in the positive direction, and then increases in the reverse direction to the maximum jerk j max , and then maintain the maximum jerk j max It remains unchanged during the T2 period, and finally takes T3 to increase from the maximum jerk j max Reverse direction to reduce to 0.

[0049] like Figure 6 In the third case shown in FIG. 1 , when the current acceleration of the autonomous mobile device is less than the first acceleration threshold and the current jerk is less than zero, during the process of the acceleration of the autonomous mobile device decreasing to 0, the jerk change of the autonomous mobile device may be as follows: Figure 6 That is, the autonomous mobile device first takes time T1 to decrease from the current jerk j0 (current jerk) in the reverse direction to 0, and then increases in the forward direction to a certain value, and then takes time T2 to decrease from the certain value to 0.

[0050] In order to ensure that the speed change can be accurately calculated, the embodiment of the present application provides a speed change calculation method corresponding to each of the above three situations.

[0051] In some embodiments, for Figure 4 In the first case shown, when the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero, the speed change can be calculated according to the current speed, current acceleration, current jerk and jerk of the autonomous mobile device. For example, the speed change can be calculated using the following expression:

[0052]

[0053]

[0054]

[0055]

[0056]

[0057] j1=j0-kT1

[0058]

[0059] Δ v =v2-v0

[0060] Among them, j c It is an intermediate quantity used to simplify the calculation formula and has no actual meaning; j0 represents the current acceleration of the autonomous mobile device; k represents the jerk of the autonomous mobile device; a0 represents the current acceleration of the autonomous mobile device; T2 represents Figure 4 The autonomous mobile device shown is accelerated from the maximum jerk j max The time it takes to decrease in the reverse direction to 0; T1 represents Figure 4 The autonomous mobile device shown decreases from the current jerk j0 to 0 in the positive direction and increases in the negative direction to the maximum jerk j max The time spent in the process; v1 represents the speed of the autonomous mobile device after T1 time; v0 represents the current speed of the autonomous mobile device; a1 represents the acceleration of the autonomous mobile device after T1 time; j1 represents the acceleration of the autonomous mobile device after T1 time; v2 represents the speed of the autonomous mobile device after T1+T2 time; Δ v It indicates the speed change of the autonomous mobile device from the current acceleration a0 to 0.

[0061] In other embodiments, Figure 5 In the second case shown, when the current acceleration is greater than the second acceleration threshold, the speed change can be calculated according to the current speed, current acceleration, current jerk, maximum jerk and jerk of the autonomous mobile device. For example, the speed change when the current acceleration is greater than the second acceleration threshold can be calculated using the following expression.

[0062]

[0063]

[0064]

[0065]

[0066]

[0067]

[0068] a2=a1-j max T2

[0069]

[0070] Δ v =v3-v0

[0071] Among them, T1 represents Figure 5 The autonomous mobile device shown decreases from the current jerk j0 to 0 in the positive direction and increases in the negative direction to the maximum jerk j max The time spent in the process; j0 represents the current acceleration of the autonomous mobile device; j max represents the preset maximum acceleration; k represents the jerk of the autonomous mobile device; T3 represents Figure 5 The autonomous mobile device shown is accelerated from the maximum jerk j max The time it takes to decrease to 0; T2 represents Figure 5 The autonomous mobile device shown is accelerated from the maximum jerk j max The time taken to decrease in the reverse direction to 0; a0 represents the current acceleration of the autonomous mobile device; v1 represents the speed of the autonomous mobile device after T1 time; v0 represents the current speed of the autonomous mobile device; a1 represents the acceleration of the autonomous mobile device after T1 time; v2 represents the speed of the autonomous mobile device after T1+T2 time; a2 represents the acceleration of the autonomous mobile device after T1+T2 time; v3 represents the speed of the autonomous mobile device after T1+T2+T3 time; Δ v It indicates the speed change of the autonomous mobile device from the current acceleration a0 to 0.

[0072] In some further embodiments, Figure 6 In the third case shown, when the current acceleration is less than the first acceleration threshold and the current jerk is less than zero, the speed change can be calculated according to the current speed, current acceleration, current jerk and jerk of the autonomous mobile device. For example, the speed change when the current acceleration is less than the first acceleration threshold and the current jerk is less than zero can be calculated using the following expression:

[0073]

[0074]

[0075]

[0076]

[0077]

[0078] j1=j0+kT1

[0079]

[0080] Δ v =v2-v0

[0081] Among them, j c It is an intermediate quantity used to simplify the calculation formula and has no actual meaning; j0 represents the current acceleration of the autonomous mobile device; k represents the jerk of the autonomous mobile device; a0 represents the current acceleration of the autonomous mobile device; T1 represents Figure 6 The autonomous mobile device shown is accelerated from the maximum jerk j max The time it takes to decrease in the reverse direction to 0 and increase in the forward direction to a certain value; T2 represents Figure 6 The time taken by the autonomous mobile device to decrease from a certain value to 0; v1 represents the speed of the autonomous mobile device after T1 time; v0 represents the current speed of the autonomous mobile device; a1 represents the acceleration of the autonomous mobile device after T1 time; j1 represents the acceleration of the autonomous mobile device after T1 time; v2 represents the speed of the autonomous mobile device after T1+T2 time; Δ v It indicates the speed change of the autonomous mobile device from the current acceleration a0 to 0.

[0082] Step S130 , performing speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk, and the jerk.

[0083] In some implementations, speed planning may include: calculating the next speed according to the speed change and the current speed. For example, the sum of the speed change and the current speed of the autonomous mobile device may be calculated as the next speed.

[0084] In some other embodiments, the speed planning may further include: calculating the acceleration change according to the current jerk and the jerk; and calculating the next acceleration according to the acceleration change and the current acceleration. The acceleration change may refer to the acceleration change of the autonomous mobile device during the process of decreasing the current jerk to 0. For example, the acceleration change may be calculated using the following expression:

[0085]

[0086] Among them, Δ a represents the change in acceleration of the autonomous mobile device during the process of decreasing the current jerk to 0; j0 represents the current jerk of the autonomous mobile device; and k represents a preset jerk.

[0087] For example, the sum of the acceleration change and the current acceleration of the autonomous mobile device may be calculated as the next acceleration.

[0088] In some other embodiments, speed planning may further include: obtaining a minimum speed limit in a speed limit queue, the speed limit queue including a plurality of preset speed limits; and adjusting the current jerk according to the minimum speed limit, the next speed, the next acceleration, and the jerk. The plurality of preset speed limits included in the speed limit queue may be determined according to the surrounding environment information perceived by the autonomous mobile device in real time, and please refer to the relevant parts in the subsequent embodiments for details.

[0089] Among them, "adjusting the current jerk according to the minimum limit speed, the next speed, the next acceleration and the jerk" may include: determining whether the next speed is greater than or equal to the minimum limit speed; if the next speed is greater than or equal to the minimum limit speed, reducing the current jerk by the jerk; if the next speed is less than the minimum limit speed, adjusting the current jerk according to the next acceleration and the jerk.

[0090] Among them, "adjusting the current jerk according to the next acceleration and the jerk" may include: obtaining a preset maximum acceleration; determining whether the next acceleration is greater than or equal to the maximum acceleration; if the next acceleration is greater than or equal to the maximum acceleration, reducing the current jerk by the jerk; if the next acceleration is less than the maximum acceleration, increasing the current jerk by the jerk.

[0091] The jerk in the embodiment of the present application is increased or decreased according to a preset jerk, so that the change of the jerk is a continuous change, which can improve the smoothness of the speed curve and thus improve the moving stability of the autonomous mobile device.

[0092] For ease of understanding, an example is provided here to illustrate the jerk increase / decrease strategy provided by the embodiment of the present application, that is, how to adjust the current jerk. Figure 7 , it can be determined whether the sum of the current speed of the autonomous mobile device and the above-mentioned speed change (next speed) is greater than or equal to the minimum speed limit; when the next speed is greater than or equal to the minimum speed limit, the current jerk of the autonomous mobile device is reduced by the jerk; when the next speed is less than the minimum speed limit, it is further determined whether the current acceleration of the autonomous mobile device and the sum of the above-mentioned acceleration change (next acceleration) is greater than or equal to the maximum acceleration; when the next acceleration is greater than or equal to the maximum acceleration, the current jerk of the autonomous mobile device is reduced by the jerk; when the next acceleration is less than the maximum acceleration, the current jerk of the autonomous mobile device is increased by the jerk.

[0093] The speed planning method provided in the embodiment of the present application can calculate the speed change according to the current acceleration, the current jerk, the preset maximum jerk and the preset jerk, and perform speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk and the jerk, thereby performing real-time speed planning. In addition, in the embodiment of the present application, the jerk is increased or decreased according to the preset jerk, so that the change in jerk is a continuous change, which can improve the smoothness of the speed curve, thereby improving the movement stability of the autonomous mobile device, thereby improving the problems of the current speed planning method that cannot perform real-time speed planning and the unstable movement of the autonomous mobile device.

[0094] Figure 8 1 is a flow chart of a speed planning method provided by another embodiment of the present application. The speed planning method can be applied to a speed planning system (or a speed planning and strategy selector therein) or a speed planning device or an autonomous mobile device. The speed planning method may include the following steps S210 to S260.

[0095] Step S210 , obtaining the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device.

[0096] Step S220, calculating the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0097] For the detailed description of step S210 and step S220 , please refer to the relevant parts of the aforementioned step S110 and step S120 .

[0098] Step S230, obtaining the current sub-path and a preset first speed limit corresponding to the current sub-path.

[0099] There is a pre-set total path between the starting position of the movement of the autonomous mobile device and the destination, and the total path may include multiple sub-paths, each sub-path has a corresponding pre-set speed limit, and the speed limit corresponding to each sub-path may include one or more speed limits. For example, the first speed limit corresponding to the current sub-path of the autonomous mobile device may include, but is not limited to, one or more of the following speed limits: the maximum speed limit when the autonomous mobile device moves on the current sub-path, and the speed limit set according to the excessive maximum centrifugal force of the curve corresponding to the current sub-path. The first speed limit can be used to constrain the speed of the autonomous mobile device moving on the current sub-path, so as to ensure the smoothness and safety of the movement of the autonomous mobile device.

[0100] The identification information of the current sub-path may be obtained, and the identification information is preset and used to identify the position of the current sub-path in the total path. For example, the identification information of 2 may indicate that the current sub-path belongs to the second sub-path in the total path. Based on the preset correspondence between the identification information and the speed limit, the speed limit corresponding to the identification information of the current sub-path may be obtained as the first speed limit.

[0101] Step S240, obtaining the surrounding environment information of the current location of the autonomous mobile device, and obtaining a preset second speed limit corresponding to the surrounding environment information.

[0102] The autonomous mobile device is equipped with a plurality of sensors, which can be used to sense the surrounding environment information of the current location of the autonomous mobile device. The surrounding environment information may include but is not limited to video information and image information.

[0103] The autonomous mobile device is installed with a pre-trained environment recognition model, which can be used to determine the environment type of the environment in which the autonomous mobile device is currently located according to the surrounding environment information, wherein the environment type may include but is not limited to a narrow channel type, a bumpy road type, and a crowd center type. A speed limit corresponding to the environment type of the environment in which the autonomous mobile device is currently located can be obtained as a second speed limit. The second speed limit can be used to constrain the speed at which the autonomous mobile device moves on the current sub-path, thereby ensuring the stability and safety of the movement of the autonomous mobile device.

[0104] In some embodiments, if it is determined based on the surrounding environment information that the environment currently located by the autonomous mobile device corresponds to multiple environment types, the second speed limit includes speed limits corresponding to the multiple environment types. For example, if the environment currently located by the autonomous mobile device is a bumpy road type and a narrow channel type, the second speed limit may include a speed limit corresponding to the bumpy road type and a speed limit corresponding to the narrow channel type.

[0105] Step S250: establishing a speed limit queue based on the first speed limit and the second speed limit.

[0106] After obtaining the first speed limit and the second speed limit, a speed limit queue may be established based on the first speed limit and the second speed limit, so as to obtain the minimum speed limit of the autonomous mobile device moving on the current sub-path from the speed limit queue.

[0107] Step S260, calculate the next speed according to the speed change and the current speed; calculate the acceleration change according to the current jerk and the jerk; calculate the next acceleration according to the acceleration change and the current acceleration; obtain the minimum speed limit in the speed limit queue; adjust the current jerk according to the minimum speed limit, the next speed, the next acceleration and the jerk.

[0108] For a detailed description of step S260 , please refer to the relevant part of the aforementioned step S130 .

[0109] Compared to Figure 2 The speed planning method shown in the figure, the speed planning method of this embodiment also has the following technical effects: the first speed limit corresponding to the current sub-path can be obtained, the surrounding environment information can be perceived in real time and the second speed limit can be obtained according to the surrounding environment information, and a speed limit queue is established based on the first speed limit and the second speed limit, taking into account the speed limit on each sub-path and the speed limit corresponding to the current environment of the autonomous mobile device, thereby ensuring the stability and safety of the autonomous mobile device during movement.

[0110] Fig. 9 1 is a flow chart of a speed planning method provided by another embodiment of the present application. The speed planning method can be applied to a speed planning system (or a speed planning and strategy selector therein) or a speed planning device or an autonomous mobile device. The speed planning method may include the following steps S310 to S390.

[0111] Step S310 , obtaining the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device.

[0112] Step S320, calculating the velocity change according to the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0113] For the detailed description of step S310 and step S320 , please refer to the relevant parts of the aforementioned step S110 and step S120 .

[0114] Step S330, obtaining the current sub-path and a preset first speed limit corresponding to the current sub-path.

[0115] Step S340, obtaining the surrounding environment information of the current location of the autonomous mobile device, and obtaining a preset second speed limit corresponding to the surrounding environment information.

[0116] For the detailed description of step S330 and step S340, please refer to the relevant parts of the aforementioned step S230 and step S240.

[0117] Step S350 , obtaining a preset maximum acceleration, a preset distance threshold, the current position of the autonomous mobile device, and a preset third speed limit corresponding to the end point of the current sub-path.

[0118] The autonomous mobile device includes a plurality of sensors, and the current position of the autonomous mobile device can be acquired in real time through the plurality of sensors.

[0119] The third speed limit is used to constrain the initial speed of the autonomous mobile device entering the next sub-path to ensure that the initial speed of the autonomous mobile device entering the next sub-path is less than or equal to the third speed limit, thereby ensuring the movement stability of the autonomous mobile device.

[0120] Based on the correspondence between the identification information of the sub-path and the sub-path endpoint speed, the sub-path endpoint speed corresponding to the identification information of the current sub-path may be acquired as the third speed limit.

[0121] Step S360, based on the third speed limit, the current position, the current speed, the current acceleration, the maximum acceleration, the current jerk, the maximum jerk and the jerk, calculate the position change of the autonomous mobile device in the process of decreasing from the current speed to the third speed limit.

[0122] The inventors have found in long-term research that the position change of the autonomous mobile device in the process of reducing the current speed to the third speed limit can be calculated in the following two situations:

[0123] The first situation: when the autonomous mobile device is currently in the acceleration stage, during the process of the autonomous mobile device decreasing from the current speed to the third limit speed, the movement of the autonomous mobile device can be divided into the following Fig.10 The following three sub-stages 1) to 3) are shown:

[0124] 1) Acceleration sub-stage. In the acceleration sub-stage, the jerk changes of the autonomous mobile device may include the above Figure 4 , Figure 5 , Figure 6 In order to accurately calculate the above position change, the embodiments of the present application respectively focus on the above Figure 4 , Figure 5 , Figure 6 For the three cases, three different methods for calculating the distance traveled by the autonomous mobile device in the acceleration sub-phase (ie, the first distance) are designed. For details, please refer to the subsequent detailed introduction section on calculating the first distance.

[0125] 2) Uniform speed sub-stage. The distance traveled by the autonomous mobile device in the uniform speed sub-stage can be directly calculated according to the speed and time of the autonomous mobile device in the uniform speed sub-stage. For details, please refer to the detailed introduction of calculating the third distance later.

[0126] 3) Deceleration sub-stage. In the deceleration sub-stage, the acceleration change of the autonomous mobile device may include: Fig.11 , Fig.12 , Fig.13 In the three cases shown in FIG. 1 (please refer to the detailed description of the subsequent calculation of the second distance for details), in order to accurately calculate the above position change, the embodiments of the present application are respectively directed to Fig.11 , Fig.12 , Fig.13 For the three cases, three different methods for calculating the distance traveled by the autonomous mobile device in the deceleration sub-phase (ie, the second distance) are designed. For details, please refer to the subsequent detailed introduction section on calculating the second distance.

[0127] It can be seen that the position change in the first case is the sum of the distance traveled by the autonomous mobile device in the acceleration sub-stage (i.e., the first distance), the distance traveled by the autonomous mobile device in the uniform speed sub-stage (i.e., the third distance), and the distance traveled by the autonomous mobile device in the deceleration sub-stage (i.e., the second distance).

[0128] In some embodiments, for the first situation, when the autonomous mobile device is in the acceleration stage, the first distance can be calculated based on the current position, current speed, current acceleration, current jerk, maximum jerk and jerk; the second distance can be calculated based on the third speed limit, current position, current speed, maximum acceleration, maximum jerk and jerk; the pre-set uniform speed time is obtained, and the third distance is calculated based on the uniform speed time and the current speed; and the sum of the first distance, the second distance and the third distance is calculated as the above-mentioned position change.

[0129] The second situation: when the autonomous mobile device is currently in the deceleration stage, during the process of the autonomous mobile device decreasing from the current speed to the third limit speed, the movement of the autonomous mobile device can be divided into the following Fig.14 The following two sub-phases 1) and 2) are shown:

[0130] 1) Acceleration sub-stage. In the acceleration sub-stage, the jerk changes of the autonomous mobile device may include the above Figure 4 , Figure 5 , Figure 6 In order to accurately calculate the above position change, the embodiments of the present application respectively focus on the above Figure 4 , Figure 5 , Figure 6For the three cases, three different methods for calculating the distance traveled by the autonomous mobile device in the acceleration sub-phase (ie, the first distance) are designed. For details, please refer to the subsequent detailed introduction section on calculating the first distance.

[0131] 2) Deceleration sub-stage. In the deceleration sub-stage, the acceleration change of the autonomous mobile device may include: Fig.11 , Fig.12 , Fig.13 In order to accurately calculate the above position change, the embodiments of the present application are respectively directed to Fig.11 , Fig.12 , Fig.13 For the three cases, three different methods for calculating the distance traveled by the autonomous mobile device in the deceleration sub-phase (ie, the second distance) are designed. For details, please refer to the subsequent detailed introduction section on calculating the second distance.

[0132] It can be seen that the position change in the second case is the difference between the distance traveled by the autonomous mobile device in the acceleration sub-phase (ie, the first distance) and the distance traveled by the autonomous mobile device in the deceleration sub-phase (ie, the second distance).

[0133] In some embodiments, for the second situation, when the autonomous mobile device is in the deceleration stage, the first distance can be calculated based on the current position, current speed, current acceleration, current jerk, maximum jerk and jerk; the second distance can be calculated based on the third speed limit, current position, current speed, maximum acceleration, maximum jerk and jerk; and the difference between the first distance and the second distance is calculated as the above-mentioned position change.

[0134] The above-mentioned “calculating the first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk” may include Figure 4 , Figure 5 , Figure 6 In the following three cases (please refer to the relevant part in the aforementioned step S120 for details), in order to ensure that the position change can be accurately calculated, the embodiment of the present application is directed to the above Figure 4 , Figure 5 , Figure 6 For each of the three cases shown, a first distance calculation method corresponding to each case is provided.

[0135] In some embodiments, for example Figure 4In the first case shown, when the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero, the first distance can be calculated according to the current position, the current speed, the current acceleration, the current jerk and the jerk. For example, the first distance can be calculated using the following expression:

[0136]

[0137]

[0138]

[0139]

[0140]

[0141]

[0142] j1=j0-kT1

[0143]

[0144]

[0145] Among them, j c It is an intermediate quantity used to simplify the calculation formula and has no actual meaning; j0 represents the current acceleration of the autonomous mobile device; k represents the jerk of the autonomous mobile device; a0 represents the current acceleration of the autonomous mobile device; T1 represents Figure 4 The autonomous mobile device shown decreases from the current jerk j0 to 0 in the positive direction and increases in the negative direction to the maximum jerk j max The time spent in the process; T2 represents Figure 4 The autonomous mobile device shown is accelerated from the maximum jerk j max The time taken to decrease in the reverse direction to 0; s1 represents the position of the autonomous mobile device after T1 time; s0 represents the current position of the autonomous mobile device; v0 represents the current speed of the autonomous mobile device; v1 represents the speed of the autonomous mobile device after T1 time; a1 represents the acceleration of the autonomous mobile device after T1 time; j1 represents the acceleration of the autonomous mobile device after T1 time; s2 represents the position of the autonomous mobile device after T1+T2 time; Indicates the first distance.

[0146] In other embodiments, Figure 5In the second case shown, when the current acceleration is greater than the second acceleration threshold, the first distance can be calculated according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk. For example, the first distance can be calculated using the following expression:

[0147]

[0148]

[0149]

[0150]

[0151]

[0152]

[0153]

[0154]

[0155] a2=a1-j max T2

[0156]

[0157]

[0158] Among them, T1 represents Figure 5 The autonomous mobile device shown decreases from the current jerk j0 to 0 in the positive direction and increases in the negative direction to the maximum jerk j max The time spent in the process; j0 represents the current acceleration of the autonomous mobile device; j max represents the preset maximum acceleration; k represents the jerk of the autonomous mobile device; T3 represents Figure 5 The autonomous mobile device shown is accelerated from the maximum jerk j max The time it takes to decrease to 0; T2 represents Figure 5 The autonomous mobile device shown is accelerated from the maximum jerk j maxThe time spent in the process of decreasing in the reverse direction to 0; a0 represents the current acceleration of the autonomous mobile device; s1 represents the position of the autonomous mobile device after T1 time; s0 represents the current position of the autonomous mobile device; v0 represents the current speed of the autonomous mobile device; v1 represents the speed of the autonomous mobile device after T1 time; a1 represents the acceleration of the autonomous mobile device after T1 time; s2 represents the position of the autonomous mobile device after T1+T2 time; v2 represents the speed of the autonomous mobile device after T1+T2 time; a2 represents the acceleration of the autonomous mobile device after T1+T2 time; s3 represents the position of the autonomous mobile device after T1+T2+T3 time; Indicates the first distance.

[0159] In some further embodiments, Figure 6 In the third case shown, when the current acceleration is less than the first acceleration threshold and the current jerk is less than zero, the first distance can be calculated according to the current position, the current speed, the current acceleration, the current jerk and the jerk. For example, the first distance can be calculated using the following expression:

[0160]

[0161]

[0162]

[0163]

[0164]

[0165]

[0166] j1=j0+kT1

[0167]

[0168]

[0169] Among them, j c It is an intermediate quantity used to simplify the calculation formula and has no actual meaning; j0 represents the current acceleration of the autonomous mobile device; k represents the jerk of the autonomous mobile device; a0 represents the current acceleration of the autonomous mobile device; T2 represents Figure 6 The time taken by the autonomous mobile device to decrease from a certain value to 0; T1 represents Figure 6 The autonomous mobile device shown is accelerated from the maximum jerk j maxThe time taken to decrease in the reverse direction to 0 and increase in the forward direction to a certain value; s1 represents the position of the autonomous mobile device after T1 time; s0 represents the current position of the autonomous mobile device; v0 represents the current speed of the autonomous mobile device; v1 represents the speed of the autonomous mobile device after T1 time; a1 represents the acceleration of the autonomous mobile device after T1 time; j1 represents the acceleration of the autonomous mobile device after T1 time; s2 represents the position of the autonomous mobile device after T1+T2 time; Indicates the first distance.

[0170] The above-mentioned “calculating the second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk” may include: calculating the first speed threshold according to the maximum jerk and the jerk; calculating the second speed threshold according to the maximum acceleration, the maximum jerk and the jerk; calculating the second speed according to the current speed and the third speed limit; calculating the second distance according to the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk.

[0171] For example, the following expression may be used to calculate the first speed threshold according to the maximum jerk and the jerk:

[0172]

[0173]

[0174] Among them, T1 represents Fig.12 or Fig.13 The jerk of the autonomous mobile device in the deceleration sub-phase shown changes from 0 to the maximum jerk j each time. max , or each time the maximum jerk changes from j max The time taken to reach 0; max represents the maximum jerk; k represents the jerk; V1 represents the first velocity threshold.

[0175] For example, the second speed threshold may be calculated using the following expression according to the maximum acceleration, the maximum jerk, and the jerk:

[0176]

[0177]

[0178] V2=j max (2T1+T2)(T1+T2)

[0179] Among them, T1 represents Fig.12 or Fig.13 The jerk of the autonomous mobile device in the deceleration sub-phase shown changes from 0 to the maximum jerk j each time. max , or each time the maximum jerk changes from j max The time taken to reach 0; max represents the maximum jerk; k represents the jerk; T2 represents Fig.13 The time during which the autonomous mobile device keeps the maximum jerk constant in the deceleration sub-phase; a max represents the maximum acceleration; V2 represents the second speed threshold.

[0180] For example, the following expression can be used to calculate the second speed according to the current speed and the third speed limit:

[0181] V t =v s -v f

[0182] Among them, V r Indicates the second speed; v s represents the current speed of the autonomous mobile device; v f Indicates the third speed limit.

[0183] The inventors have found in their long-term research that the jerk changes of the autonomous mobile device are different when the autonomous mobile device is in the above-mentioned deceleration sub-stage according to different current acceleration values ​​of the autonomous mobile device. Fig.15 As shown, the jerk change of the autonomous mobile device in the above deceleration sub-stage may include the following three situations:

[0184] like Fig.11 In the first case shown in the figure, when the second speed is less than the first speed threshold, the jerk changes of the autonomous mobile device in the above deceleration sub-stage are as follows: the autonomous mobile device takes time T to increase from the current jerk j0(0) in the reverse direction to the maximum jerk j max , and then it takes time T to go from the maximum jerk j max It decreases in the reverse direction to 0, and then increases in the positive direction from 0 to the maximum jerk j in the time T. max , and finally it takes time T to accelerate from the maximum jerk j max Decrease to 0 in the positive direction.

[0185] like Fig.12 In the second case shown in the figure, when the second speed is greater than or equal to the first speed threshold and less than or equal to the second speed threshold, the jerk changes of the autonomous mobile device in the above deceleration sub-stage are as follows: the autonomous mobile device takes time T1 to increase from the current jerk j0(0) in the reverse direction to the maximum jerk j0(1). max , maintain the maximum jerk jmax It remains unchanged in the T time period, and takes T1 to go from the maximum jerk j max It decreases in the reverse direction to 0, and it takes time T1 to increase from 0 to the maximum jerk j max , maintain the maximum jerk j max It remains unchanged in the T time period, and takes T1 to go from the maximum jerk j max Decrease to 0 in the positive direction.

[0186] like Fig.13 In the third case shown in the figure, when the second speed is greater than the second speed threshold, the jerk changes of the autonomous mobile device in the above deceleration sub-stage are as follows: the autonomous mobile device takes time T1 to increase from the current jerk j0(0) in the reverse direction to the maximum jerk j max , maintain the maximum jerk j max It remains unchanged in the T2 time period, and takes T1 to increase from the maximum jerk j max Decrease in the reverse direction to 0, keep the jerk at 0 in the T time period, and increase from 0 to the maximum jerk j in the time period T1 max , maintain the maximum jerk j max It remains unchanged in the T2 time period, and takes T1 to increase from the maximum jerk j max Decrease to 0 in the positive direction.

[0187] In order to ensure that the position change can be accurately calculated, the embodiment of the present application is directed to the above Fig.11 , Fig.12 , Fig.13 For each of the three cases shown, a second distance calculation method corresponding to each case is provided.

[0188] In some embodiments, for example Fig.11 In the first case shown, when the second speed is less than the first speed threshold, the second distance can be calculated according to the third speed limit, the current position, the current speed and the jerk. For example, the second distance can be calculated using the following expression:

[0189]

[0190]

[0191]

[0192] Where T represents Fig.11 The time taken for the jerk of the autonomous mobile device to change from 0 to the maximum jerk or from the maximum jerk to 0 in the deceleration sub-phase shown; s represents the current speed of the autonomous mobile device; v frepresents the third speed limit; k represents the jerk acceleration; s4 represents the position of the autonomous mobile device after T+T+T+T time; s0 represents the current position of the autonomous mobile device; Indicates the second distance.

[0193] In other embodiments, for example Fig.12 In the second case shown, when the second speed is greater than or equal to the first speed threshold and less than or equal to the second speed threshold, the second distance can be calculated according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk. For example, the second distance can be calculated using the following expression:

[0194]

[0195]

[0196]

[0197]

[0198]

[0199]

[0200]

[0201] a2=a1-j max T

[0202]

[0203]

[0204]

[0205]

[0206]

[0207]

[0208]

[0209]

[0210] a5=a4+j max T

[0211]

[0212]

[0213] Among them, T1 represents Fig.12 or Fig.13 The jerk of the autonomous mobile device in the deceleration sub-phase shown changes from 0 to the maximum jerk j each time. max , or each time the maximum jerk changes from j max The time taken to reach 0; max represents the maximum jerk; k represents the jerk; s1 represents the position of the autonomous mobile device after T1 time; v s represents the current speed of the autonomous mobile device; v f represents the third speed limit; v1 represents the speed of the autonomous mobile device after T1 time; a1 represents the acceleration of the autonomous mobile device after T1 time; T represents Fig.12 The maximum jerk j is maintained at each time as shown max time; s2 represents the position of the autonomous mobile device after T1+T time; v2 represents the speed of the autonomous mobile device after T1+T time; a2 represents the acceleration of the autonomous mobile device after T1+T time; s3 represents the position of the autonomous mobile device after T1+T+T1 time; v3 represents the speed of the autonomous mobile device after T1+T+T1 time; a3 represents the acceleration of the autonomous mobile device after T1+T+T1 time; s4 represents the position of the autonomous mobile device after T1+T+T1+T1 time; v4 represents the speed of the autonomous mobile device after T1+T+T1+T1 time. a4 represents the speed after T1+T+T1+T1; a4 represents the acceleration of the autonomous mobile device after T1+T+T1+T1; s5 represents the position of the autonomous mobile device after T1+T+T1+T1+T; v5 represents the speed of the autonomous mobile device after T1+T+T1+T1+T; a5 represents the acceleration of the autonomous mobile device after T1+T+T1+T1+T; s6 represents the position of the autonomous mobile device after T1+T+T1+T1+T+T1; s0 represents the current position of the autonomous mobile device; Indicates the second distance.

[0214] In some other embodiments, Fig.13 In the third case shown, when the second speed is greater than the second speed threshold, the second distance can be calculated according to the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk. For example, the second distance can be calculated using the following expression:

[0215]

[0216]

[0217]

[0218]

[0219]

[0220]

[0221]

[0222]

[0223]

[0224]

[0225] a3=-a max

[0226]

[0227] v4=v3-a max T

[0228] a4=-a max

[0229]

[0230]

[0231]

[0232]

[0233]

[0234] a6=a5+j max T2

[0235]

[0236]

[0237] Among them, T1 represents Fig.12 or Fig.13 The jerk of the autonomous mobile device in the deceleration sub-phase shown changes from 0 to the maximum jerk j each time. max , or each time the maximum jerk changes from j max The time taken to reach 0; max represents the maximum jerk; k represents the jerk; T2 represents Fig.13 The time during which the autonomous mobile device maintains the maximum jerk each time; a maxrepresents the maximum acceleration; s1 represents the position of the autonomous mobile device after T1 time; v s represents the current speed of the autonomous mobile device; v1 represents the speed of the autonomous mobile device after T1 time; a1 represents the acceleration of the autonomous mobile device after T1 time; s2 represents the position of the autonomous mobile device after T1+T2 time; v2 represents the speed of the autonomous mobile device after T1+T2 time; a2 represents the acceleration of the autonomous mobile device after T1+T2 time; s3 represents the position of the autonomous mobile device after T1+T+T1 time; v3 represents the speed of the autonomous mobile device after T1+T2+T1 time; a3 represents the acceleration of the autonomous mobile device after T1+T2+T1 time; s4 represents the position of the autonomous mobile device after T1+T2+T1+T time; v4 represents the speed of the autonomous mobile device after T1+T2+T1+T time; a4 represents the acceleration of the autonomous mobile device s5 represents the acceleration of the autonomous mobile device after T1+T2+T1+T+T1; v5 represents the speed of the autonomous mobile device after T1+T2+T1+T+T1; a5 represents the acceleration of the autonomous mobile device after T1+T2+T1+T+T1; s6 represents the position of the autonomous mobile device after T1+T2+T1+T+T1+T2; v6 represents the speed of the autonomous mobile device after T1+T2+T1+T+T1+T2; a6 represents the acceleration of the autonomous mobile device after T1+T2+T1+T+T1+T2; s7 represents the position of the autonomous mobile device after T1+T2+T1+T+T1+T2+T1; s0 represents the current position of the autonomous mobile device; Indicates the second distance.

[0238] Step S370: When the position change is greater than the distance threshold, a speed limit queue is established based on the first speed limit and the second speed limit.

[0239] When the position change is greater than the distance threshold, it is determined that the autonomous mobile device is far from the end point of the current sub-path, and it is not necessary to consider the initial speed limit for entering the next sub-path, and a speed limit queue can be established based on the first speed limit and the second speed limit. For a detailed description of "establishing a speed limit queue based on the first speed limit and the second speed limit", please refer to the aforementioned step S250.

[0240] Step S380: When the position change is less than or equal to the distance threshold, a speed limit queue is established based on the first speed limit, the second speed limit and the third speed limit.

[0241] When the position change is less than or equal to the distance threshold, it is determined that the autonomous mobile device is close to the end point of the current sub-path, and it is necessary to consider the limit on the initial speed for entering the next sub-path. A speed limit queue can be established based on the first limit speed, the second limit speed and the third limit speed, so as to obtain the minimum limit speed of the autonomous mobile device moving in the current sub-path from the speed limit queue.

[0242] Step S390, calculate the next speed according to the speed change and the current speed; calculate the acceleration change according to the current jerk and the jerk; calculate the next acceleration according to the acceleration change and the current acceleration; obtain the minimum limit speed in the speed limit queue; adjust the current jerk according to the minimum limit speed, the next speed, the next acceleration and the jerk.

[0243] For the detailed description of step S390, please refer to the aforementioned step S260.

[0244] Compared to Figure 2 as well as Figure 8 The speed planning method shown in the figure also has the following technical effects: based on the distance between the autonomous mobile device and the end point of the current sub-path, a decision can be made whether to build a speed limit queue based on the third limit speed used to constrain the initial speed of the autonomous mobile device to enter the next sub-path, which can further improve the stability and smoothness of the autonomous mobile device during movement.

[0245] Fig.16 1 is a flow chart of a speed planning method provided by another embodiment of the present application. The speed planning method can be applied to a speed planning system (or a speed planning and strategy selector therein) or a speed planning device or an autonomous mobile device. The speed planning method may include the following steps S410 to S440.

[0246] Step S410 , obtaining the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device.

[0247] Step S420, calculating the velocity change according to the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0248] Step S430, performing speed planning according to the speed change, the current speed, the current acceleration, the current jerk and the jerk.

[0249] For the detailed description of step S410 to step S430, please refer to the relevant parts in the aforementioned embodiment.

[0250] Step S440, sending the next speed to the controller so that the controller controls the autonomous mobile device to move at the next speed. The controller may be arranged in the autonomous mobile device.

[0251] Compared to Figure 2 , Figure 8 as well as Fig. 9 The speed planning method shown in the figure, the speed planning method of this embodiment also has the following technical effects: the autonomous mobile device can send the next speed to the controller, and the controller controls the autonomous mobile device to move at the next speed, thereby completing the autonomous movement of the autonomous mobile device.

[0252] It should be noted that the calculations involved in the speed planning methods provided in all the above method embodiments of the present application are real-time calculations, which can be performed on a single-chip microcomputer at milliseconds or even microseconds, which can reduce the requirements for computing resources and reduce costs. In practical applications, a high-performance processor can be used instead of a single-chip microcomputer to perform the above real-time calculation process, which can also achieve real-time calculation effects, but it requires excessive resources of a high-performance processor.

[0253] Fig.17 200 is a schematic diagram of the structure of the speed planning device provided in the embodiment of the present application. The speed planning device 200 can be applied to a speed planning system (or a speed planning and strategy selector therein) or an autonomous mobile device. Fig.17 As shown, the speed planning device 200 may include a data acquisition module 210 , a data processing module 220 and a speed planning module 230 .

[0254] The data acquisition module 210 is used to obtain the current speed, current acceleration, current jerk, a preset maximum jerk and a preset jerk of the autonomous mobile device, wherein the jerk is used to describe the speed of change of the acceleration and the jerk is used to describe the speed of change of the jerk.

[0255] The data processing module 220 is used to calculate the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0256] The speed planning module 230 is used to plan the speed of the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk and the jerk.

[0257] In some embodiments, the data processing module 220 is further used to calculate a first acceleration threshold based on the current acceleration and the jerk; calculate a second acceleration threshold based on the current jerk, the maximum jerk and the jerk; and calculate a velocity change based on the first acceleration threshold, the second acceleration threshold, the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0258] In some embodiments, the data processing module 220 is further used to calculate the velocity change according to the current velocity, the current acceleration, the current jerk and the jerk when the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero.

[0259] In some embodiments, the data processing module 220 is further used to calculate the speed change according to the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk when the current acceleration is greater than the second acceleration threshold.

[0260] In some embodiments, the data processing module 220 is further used to calculate the velocity change according to the current velocity, the current acceleration, the current jerk and the jerk when the current acceleration is less than the first acceleration threshold and the current jerk is less than zero.

[0261] In some implementations, the speed planning module 230 is further configured to calculate a next speed according to the speed change and the current speed.

[0262] In some embodiments, the speed planning module 230 is further configured to calculate an acceleration change according to the current jerk and the jerk; and calculate a next acceleration according to the acceleration change and the current acceleration.

[0263] In some embodiments, the speed planning module 230 is further used to obtain the minimum limit speed in the speed limit queue, wherein the speed limit queue includes multiple pre-set limit speeds; when the next speed is greater than or equal to the minimum limit speed, reduce the current jerk by the jerk; when the next speed is less than the minimum limit speed, adjust the current jerk according to the next acceleration and the jerk.

[0264] In some embodiments, the speed planning module 230 is also used to obtain a pre-set maximum acceleration; when the next acceleration is greater than or equal to the maximum acceleration, reduce the current jerk by the jerk; when the next acceleration is less than the maximum acceleration, increase the current jerk by the jerk.

[0265] In some embodiments, the speed planning module 230 is further used to obtain the current sub-path and a preset first limit speed corresponding to the current sub-path before obtaining the minimum limit speed in the speed limit queue, wherein there is a preset total path between the movement starting position and the destination of the autonomous mobile device, and the total path includes multiple sub-paths; obtain the surrounding environment information of the current position of the autonomous mobile device, and obtain a preset second limit speed corresponding to the surrounding environment information; and establish the speed limit queue based on the first limit speed and the second limit speed.

[0266] In some embodiments, the speed planning module 230 is also used to obtain a preset maximum acceleration, a preset distance threshold, the current position of the autonomous mobile device, and a preset third limit speed corresponding to the end point of the current sub-path; based on the third limit speed, the current position, the current speed, the current acceleration, the maximum acceleration, the current jerk, the maximum jerk, and the jerk, calculate the position change of the autonomous mobile device in the process of reducing from the current speed to the third limit speed; when the position change is greater than the distance threshold, establish the speed limit queue based on the first limit speed and the second limit speed.

[0267] In some implementations, the speed planning module 230 is further configured to establish the speed limit queue based on the first speed limit, the second speed limit, and the third speed limit when the position change is less than or equal to the distance threshold.

[0268] In some embodiments, the speed planning module 230 is also used to calculate a first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk when the autonomous mobile device is in an acceleration stage; calculate a second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk; obtain a pre-set uniform speed time, and calculate a third distance according to the uniform speed time and the current speed; and calculate the sum of the first distance, the second distance and the third distance as the position change.

[0269] In some embodiments, the speed planning module 230 is further used to calculate a first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk when the autonomous mobile device is in a deceleration stage; calculate a second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk; and calculate the difference between the first distance and the second distance as the position change.

[0270] In some embodiments, the velocity planning module 230 is further used to calculate a first acceleration threshold based on the current jerk and the jerk; calculate a second acceleration threshold based on the current jerk, the maximum jerk and the jerk; and calculate a first distance based on the first acceleration threshold, the second acceleration threshold, the current position, the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk.

[0271] In some embodiments, the speed planning module 230 is further used to calculate the first distance according to the current position, the current speed, the current acceleration, the current jerk and the jerk when the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero.

[0272] In some embodiments, the speed planning module 230 is further used to calculate the first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk when the current acceleration is greater than the second acceleration threshold.

[0273] In some embodiments, the speed planning module 230 is further used to calculate the first distance according to the current position, the current speed, the current acceleration, the current jerk and the jerk when the current acceleration is less than the first acceleration threshold and the current jerk is less than zero.

[0274] In some embodiments, the speed planning module 230 is further used to calculate a first speed threshold based on the maximum jerk and the jerk; calculate a second speed threshold based on the maximum acceleration, the maximum jerk and the jerk; calculate a second speed based on the current speed and the third speed limit; calculate a second distance based on the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk.

[0275] In some embodiments, the speed planning module 230 is further configured to calculate a second distance according to the third speed limit, the current position, the current speed, and the jerk when the second speed is less than the first speed threshold.

[0276] In some embodiments, the speed planning module 230 is further used to calculate the second distance based on the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk when the second speed is greater than or equal to the first speed threshold and less than or equal to the second speed threshold.

[0277] In some embodiments, the speed planning module 230 is further configured to calculate a second distance based on the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk when the second speed is greater than the second speed threshold.

[0278] In some implementations, the speed planning module 230 is further configured to send the next speed to the controller, so that the controller controls the autonomous mobile device to move at the next speed.

[0279] Those skilled in the art can clearly understand that the speed planning device 200 provided in the embodiment of the present application can implement the speed 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 speed planning method in the embodiment of the present application, which will not be repeated here.

[0280] 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.

[0281] 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.

[0282] Fig.18 300 is a schematic diagram of the structure of the autonomous mobile device provided in the embodiment of the present application. The autonomous mobile device 300 may include one or more of the following components: a memory 310, one or more processors 320, and one or more applications, wherein the one or more applications may be stored in the memory 310 and configured to execute the above-mentioned speed planning method provided in the embodiment of the present application when called by the one or more processors 320. The autonomous mobile device 300 may refer to a robot or vehicle with autonomous mobile function. For example, the autonomous mobile device may include but is not limited to AMR and AGV.

[0283] The processor 320 may include one or more processing cores. The processor 320 uses various interfaces and lines to connect various parts of the entire autonomous mobile device 300, and is used to run or execute instructions, programs, code sets or instruction sets stored in the memory 310, and call to run or execute data stored in the memory 310, perform various functions of the autonomous mobile device 300, and process data.

[0284] The processor 320 may 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).

[0285] The processor 320 may integrate one or a combination of a central processing unit (CPU), a graphics processing unit (GPU), and a modem. 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 320, but may be implemented separately through a communication chip.

[0286] The memory 310 may include a random access memory (RAM) or a read-only memory (ROM). The memory 310 may be used to store instructions, programs, codes, code sets or instruction sets. The memory 310 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 300 during use, etc.

[0287] Fig.19 The computer-readable storage medium 400 stores a program code 410, which is configured to execute the speed planning method provided in the embodiment of the present application when called by the processor.

[0288] The computer-readable storage medium 400 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.

[0289] In some embodiments, the computer-readable storage medium 400 may include a non-transitory computer-readable medium (Non-TCRSM).

[0290] The computer readable storage medium 400 has storage space for program code 410 for executing any method step of the above method. These program codes 410 can be read from or written into one or more computer program products. The program code 410 can be compressed in an appropriate form.

[0291] 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 speed planning method, characterized in that: include: Obtaining the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device, wherein the jerk is used to describe the speed of change of the acceleration, and the jerk is used to describe the speed of change of the jerk; Calculating a velocity change according to the current velocity, the current acceleration, the current jerk, the maximum jerk, and the jerk; Speed ​​planning is performed on the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk, and the jerk.

2. The method according to claim 1, characterized in that The calculating the velocity change amount according to the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk includes: Calculating a first acceleration threshold according to the current jerk and the jerk; Calculating a second acceleration threshold according to the current jerk, the maximum jerk, and the jerk; A velocity change is calculated according to the first acceleration threshold, the second acceleration threshold, the current velocity, the current acceleration, the current jerk, the maximum jerk, and the jerk.

3. The method according to claim 2, characterized in that The calculating the speed change according to the first acceleration threshold, the second acceleration threshold, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk includes: When the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero, the velocity change is calculated based on the current velocity, the current acceleration, the current jerk, and the jerk.

4. The method according to claim 2, characterized in that: The calculating the velocity variation according to the first acceleration threshold, the second acceleration threshold, the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk further includes: When the current acceleration is greater than the second acceleration threshold, a velocity change is calculated according to the current velocity, the current acceleration, the current jerk, the maximum jerk, and the jerk.

5. The method according to claim 2, characterized in that: The calculating the velocity variation according to the first acceleration threshold, the second acceleration threshold, the current velocity, the current acceleration, the current jerk, the maximum jerk and the jerk further includes: When the current acceleration is less than the first acceleration threshold and the current jerk is less than zero, a velocity change is calculated according to the current velocity, the current acceleration, the current jerk, and the jerk.

6. The method according to any one of claims 1 to 5, characterized in that: The performing speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk, and the jerk includes: The next speed is calculated according to the speed change and the current speed.

7. The method according to claim 6, characterized in that The performing speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk, and the jerk further includes: Calculating an acceleration change according to the current jerk and the jerk; The next acceleration is calculated according to the acceleration change and the current acceleration.

8. The method according to claim 7, characterized in that The performing speed planning for the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk, and the jerk further includes: Obtaining a minimum speed limit in a speed limit queue, wherein the speed limit queue includes a plurality of preset speed limits; When the next speed is greater than or equal to the minimum speed limit, reducing the current jerk by the jerk; When the next speed is less than the minimum speed limit, the current jerk is adjusted according to the next acceleration and the jerk.

9. The method according to claim 8, characterized in that The adjusting the current jerk according to the next acceleration and the jerk includes: Get the preset maximum acceleration; When the next acceleration is greater than or equal to the maximum acceleration, reducing the current jerk by the jerk; When the next acceleration is less than the maximum acceleration, the current jerk is increased by the jerk.

10. The method according to claim 8, characterized in that Before obtaining the minimum speed limit in the speed limit queue, the method further includes: Acquire a current sub-path and a preset first speed limit corresponding to the current sub-path, wherein there is a preset total path between a movement starting position and a destination of the autonomous mobile device, and the total path includes a plurality of sub-paths; Acquire surrounding environment information of the current location of the autonomous mobile device, and acquire a preset second speed limit corresponding to the surrounding environment information; The speed limit queue is established based on the first speed limit and the second speed limit.

11. The method according to claim 10, characterized in that The establishing the speed limit queue based on the first speed limit and the second speed limit includes: Obtaining a preset maximum acceleration, a preset distance threshold, a current position of the autonomous mobile device, and a preset third speed limit corresponding to an end point of the current subpath; calculating, based on the third speed limit, the current position, the current speed, the current acceleration, the maximum acceleration, the current jerk, the maximum jerk, and the jerk, an amount of position change of the autonomous mobile device in a process of decreasing from the current speed to the third speed limit; When the position change is greater than the distance threshold, the speed limit queue is established based on the first speed limit and the second speed limit.

12. The method according to claim 11, characterized in that The method further comprises: When the position change is less than or equal to the distance threshold, the speed limit queue is established based on the first speed limit, the second speed limit, and the third speed limit.

13. The method according to claim 11, characterized in that The calculating, based on the third speed limit, the current position, the current speed, the current acceleration, the maximum acceleration, the current jerk, the maximum jerk, and the jerk, a position change amount of the autonomous mobile device in a process of decreasing from the current speed to the third speed limit includes: When the autonomous mobile device is in an acceleration phase, calculating a first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk; calculating a second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk; Obtaining a preset uniform speed time, and calculating a third distance according to the uniform speed time and the current speed; The sum of the first distance, the second distance and the third distance is calculated as the position change amount.

14. The method according to claim 11, characterized in that The calculating, based on the third speed limit, the current position, the current speed, the current acceleration, the maximum acceleration, the current jerk, the maximum jerk, and the jerk, a position change amount of the autonomous mobile device in a process of decreasing from the current speed to the third speed limit includes: When the autonomous mobile device is in a deceleration phase, calculating a first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk; calculating a second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk; A difference between the first distance and the second distance is calculated as the position change.

15. The method according to claim 13 or 14, characterized in that The calculating a first distance according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk includes: Calculating a first acceleration threshold according to the current jerk and the jerk; Calculating a second acceleration threshold according to the current jerk, the maximum jerk, and the jerk; A first distance is calculated according to the first acceleration threshold, the second acceleration threshold, the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk.

16. The method according to claim 15, characterized in that The calculating a first distance according to the first acceleration threshold, the second acceleration threshold, the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk includes: When the current acceleration is greater than or equal to the first acceleration threshold and less than or equal to the second acceleration threshold, or when the current acceleration is less than or equal to the first acceleration threshold and the current jerk is greater than zero, a first distance is calculated based on the current position, the current speed, the current acceleration, the current jerk, and the jerk.

17. The method according to claim 15, characterized in that The calculating the first distance according to the first acceleration threshold, the second acceleration threshold, the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk further includes: When the current acceleration is greater than the second acceleration threshold, a first distance is calculated according to the current position, the current speed, the current acceleration, the current jerk, the maximum jerk, and the jerk.

18. The method according to claim 15, characterized in that The calculating the first distance according to the first acceleration threshold, the second acceleration threshold, the current position, the current speed, the current acceleration, the current jerk, the maximum jerk and the jerk further includes: When the current acceleration is less than the first acceleration threshold and the current jerk is less than zero, a first distance is calculated according to the current position, the current speed, the current acceleration, the current jerk, and the jerk.

19. The method according to claim 13 or 14, characterized in that The calculating the second distance according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk includes: Calculating a first speed threshold according to the maximum jerk and the jerk; calculating a second speed threshold according to the maximum acceleration, the maximum jerk, and the jerk; Calculating a second speed according to the current speed and the third speed limit; A second distance is calculated according to the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk.

20. The method according to claim 19, characterized in that The calculating the second distance according to the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk includes: When the second speed is less than the first speed threshold, a second distance is calculated according to the third speed limit, the current position, the current speed, and the jerk.

21. The method according to claim 19, characterized in that The calculating the second distance according to the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk also includes: When the second speed is greater than or equal to the first speed threshold and less than or equal to the second speed threshold, a second distance is calculated according to the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk.

22. The method according to claim 19, characterized in that The calculating the second distance according to the second speed, the first speed threshold, the second speed threshold, the third speed limit, the current position, the current speed, the maximum acceleration, the maximum jerk and the jerk also includes: When the second speed is greater than the second speed threshold, a second distance is calculated according to the current position, the current speed, the maximum acceleration, the maximum jerk, and the jerk.

23. The method according to claim 6, characterized in that After calculating the next speed according to the speed change and the current speed, the method further includes: The next speed is sent to the controller, so that the controller controls the autonomous mobile device to move according to the next speed.

24. A speed planning device, characterized in that: include: A data acquisition module, used to acquire the current speed, current acceleration, current jerk, a preset maximum jerk, and a preset jerk of the autonomous mobile device, wherein the jerk is used to describe the speed of change of the acceleration, and the jerk is used to describe the speed of change of the jerk; a data processing module, configured to calculate a velocity change according to the current velocity, the current acceleration, the current jerk, the maximum jerk, and the jerk; A speed planning module is used to plan the speed of the autonomous mobile device according to the speed change, the current speed, the current acceleration, the current jerk and the jerk.

25. 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-23 when called by the one or more processors.

26. A computer-readable storage medium, characterized in that: The storage medium stores program code, and the program code is used to execute the method according to any one of claims 1 to 23 when called by a processor.

Citation Information

Cited By

  • Mobile robot local path planning method based on centrifugal force and acceleration constraint

    CN119803484A

  • A local path planning method for mobile robots based on centrifugal force and jerk constraints

    CN119803484B