阅读说明：本技术 一种自动驾驶卡车的控制方法、装置及自动驾驶卡车 (Control method and device for automatically driving truck and automatically driving truck ) 是由 刘启源 于 2019-08-20 设计创作，主要内容包括：本申请提供了一种自动驾驶卡车的控制方法、装置及自动驾驶卡车,涉及自动驾驶技术领域。方法包括：获得牵引车行驶的期望路径线,及获得挂车控制参考点参数,确定自动驾驶卡车的自动驾驶状态量；确定自动驾驶卡车的受力描述信息；获得自动驾驶状态量与自动驾驶卡车的车辆状态量的对应关系；根据受力描述信息、自动驾驶状态量和对应关系,确定牵引车的横向控制量,并发送至牵引车的转向电机控制器,以使得转向电机控制器控制牵引车的转向电机以转向控制量进行转向动作。本申请实施例考虑到自动驾驶卡车中挂车的控制精度,从而生成的牵引车的横向控制量能够使挂车的行驶收敛到牵引车行驶的期望路径线上,可以实现自动驾驶卡车的精确控制。(The application provides a control method and device for an automatic driving truck and the automatic driving truck, and relates to the technical field of automatic driving. The method comprises the following steps: obtaining an expected path line of tractor driving, obtaining trailer control reference point parameters, and determining the automatic driving state quantity of the automatic driving truck; determining stress description information of an autonomous truck; obtaining a corresponding relation between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck; and determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation, and sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity. According to the control method and the control device, the control precision of the trailer in the automatic driving truck is considered, so that the generated lateral control quantity of the trailer can enable the driving of the trailer to be converged on the expected path line of the driving of the trailer, and the accurate control of the automatic driving truck can be realized.)

1. A control method for an autonomous truck, characterized by being applied to an autonomous truck comprising a tractor and a trailer; the control method of the automatic driving truck comprises the following steps:

acquiring an expected path line for the tractor to run and acquiring trailer control reference point parameters;

determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter;

determining stress description information of an autonomous truck;

obtaining a corresponding relation between the automatic driving state quantity and a vehicle state quantity of an automatic driving truck;

determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation;

and sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity.

2. The control method of an autonomous-capable truck as recited in claim 1, wherein the desired path line traveled by the tractor is a road center line of the desired path traveled by the tractor.

3. The method of controlling an autonomous truck as recited in claim 1, characterized in that the trailer control reference point parameter comprises a position of a trailer control reference point.

4. The control method of an autonomous-capable truck as claimed in claim 3, characterized in that the autonomous-capable state quantity of the autonomous-capable truck includes a trailer position deviation, a trailer position deviation derivative;

determining an autopilot state quantity of an autopilot truck based on the desired route line and trailer control reference point parameters, comprising:

obtaining the position of a first target point closest to the position of the trailer control reference point from the expected path line, and determining the difference between the position of the trailer control reference point and the position of the first target point as the trailer position deviation;

and carrying out derivative calculation on the trailer position deviation to determine a trailer position deviation derivative.

5. The method of controlling an autonomous-capable truck as recited in claim 4, wherein determining stress description information for the autonomous-capable truck comprises:

combining the stress on each wheel of the automatic driving truck and the vehicle state quantity by applying a Lagrange mechanical function to obtain stress description information F ═ F (vessel _ st ate) or F + F (wind) ═ F (vessel _ st ate) of the automatic driving truck; wherein F represents the Lagrange abstraction of the autonomous truck; (wind) represents the wind resistance of the autonomous truck; vehicle _ st ate is a vehicle state quantity of the autonomous truck.

6. The method of controlling an autonomous-capable truck as recited in claim 4, wherein determining stress description information for the autonomous-capable truck comprises:

combining the stress on each wheel of the automatic driving truck and the vehicle state quantity by applying a Newton second motion law mechanical function to obtain stress description information F ═ F (vehicle _ st ate) or F + F (wind) ═ F (vehicle _ st ate) of the automatic driving truck; wherein F represents the stress of the tire of the automatic driving truck; (wind) represents the wind resistance of the autonomous truck; vehicle _ st ate is a vehicle state quantity of the autonomous truck.

7. The control method of an autonomous-capable truck as recited in claim 5 or 6, wherein the stress description information is F ═ F (vehicle _ st ate); the transverse control quantity of the tractor is the steering wheel angle of the tractor;

determining the lateral control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation, and the method comprises the following steps:

according to the stress description information: f (vehicle _ st ate), trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Converting a vehicle state quantity vehicle _ st ate of the autonomous truck in f (vehicle _ st ate) into f (a, δ) expressed in an autonomous driving state quantity, with the correspondence relationship; wherein A comprises trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}(ii) a Delta is the steering wheel angle of the tractor;

processing F ═ F (A, delta) according to a preset control algorithm to obtain the trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}When the preset ideal condition is satisfiedAs a result of the steering wheel angle of the tractor;

the ideal conditions include: trailer position deviation e_{Hanging rack}Within a first preset range approaching 0, the trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Respectively in a second preset range and a third preset range approaching 0.

8. The control method of an autonomous-capable truck as recited in claim 5 or 6, wherein the stress description information is F + F (wind — st ate); the transverse control quantity of the tractor is the steering wheel angle of the tractor;

determining the lateral control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation, and the method comprises the following steps:

according to the stress description information: f + F (wind) ═ F (vehicle _ st ate), trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Converting a vehicle state quantity vehicle _ st ate of the autonomous truck in f (vehicle _ st ate) into f (a, δ) expressed in an autonomous driving state quantity, with the correspondence relationship; wherein A comprises trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}(ii) a Delta is the steering wheel angle of the tractor;

processing F + F (wind) ═ F (A, delta) according to a preset control algorithm to obtain the trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}The steering wheel angle delta of the tractor when the preset ideal condition is met is used as the steering wheel angle result of the tractor;

the ideal conditions include: trailer position deviation e_{Hanging rack}Within a first preset range approaching 0, the trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Respectively in a second preset range and a third preset range approaching 0.

9. The method of controlling an autonomous-capable truck as recited in claim 8, wherein the autonomous-capable truck wind resistance comprises an autonomous-capable truck crosswind resistance; the automatic driving truck is provided with a vehicle-mounted anemometer; the method further includes obtaining a crosswind resistance of the autonomous vehicle; the obtaining of crosswind resistance of the autonomous driving truck comprises:

obtaining a first wind speed and a first wind direction through the vehicle-mounted anemometer;

and obtaining the crosswind resistance of the automatic driving truck according to the first wind speed and the first wind direction.

10. The method of controlling an autonomous-capable truck as recited in claim 8, wherein the autonomous-capable truck wind resistance comprises an autonomous-capable truck crosswind resistance; a plurality of road-side anemometers are distributed on a path along which the automatic drive truck travels; the method further includes obtaining a crosswind resistance of the autonomous vehicle; the obtaining of crosswind resistance of the autonomous driving truck comprises:

obtaining a second wind speed and a second wind direction obtained by a roadside anemometer closest to the position of the tractor control reference point or the position of the trailer control reference point;

and obtaining the crosswind resistance of the automatic driving truck according to the second wind speed and the second wind direction.

11. An on-board device of an autonomous truck, characterized by being applied to an autonomous truck comprising a tractor and a trailer; the vehicle-mounted device of the automatic driving truck comprises:

the data acquisition unit is used for acquiring an expected path line for the tractor to run and acquiring trailer control reference point parameters;

the automatic driving state quantity determining unit is used for determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter;

the stress description information determining unit is used for determining stress description information of the automatic driving truck;

a correspondence obtaining unit configured to obtain a correspondence between the automatic driving state quantity and a vehicle state quantity of an automatic driving truck;

the transverse control quantity determining unit is used for determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation;

and the control quantity sending unit is used for sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity.

12. An autonomous truck, characterized in that the autonomous truck comprises a tractor, a trailer and an on-board unit; the in-vehicle apparatus is configured to execute the control method of the automated driving truck according to claims 1 to 10.

13. A computer-readable storage medium, on which a computer program is stored, characterized in that the program, when being executed by a processor, implements the method of controlling an autonomous truck as claimed in claims 1 to 10.

14. A computer device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, characterized in that the processor implements the method of controlling an autonomous truck according to claims 1 to 10 when executing the program.

Technical Field

The application relates to the technical field of automatic driving, in particular to a control method and device for an automatic driving truck and the automatic driving truck.

Background

Currently, an autonomous truck generally includes two parts, a tractor and a trailer, with the rear of the tractor connected to the front of the trailer. When an autonomous truck is driven, the tractor is generally controlled to drive the trailer to move. The driving accuracy of the current automatic driving truck is generally measured by the control accuracy of the tractor. In some cases where the requirement for the driving accuracy is high, such as highway driving, driving in an environment disturbed by crosswind, and the like, although the control accuracy of the tractor is ensured, when the load pulled on the trailer is heavy, the risk of the vehicle rolling over still easily occurs. Therefore, the running precision of the tractor and the trailer is ensured at present, and the accurate control of the automatic driving truck is realized, so that the problem to be solved urgently is solved.

Disclosure of Invention

The embodiment of the application provides a control method and device of an automatic driving truck and the automatic driving truck so as to realize accurate control of the automatic driving truck.

In order to achieve the purpose, the technical scheme is as follows:

in a first aspect of embodiments of the present application, there is provided a control method for an autonomous truck, applied to an autonomous truck comprising a tractor and a trailer; the control method of the automatic driving truck comprises the following steps:

acquiring an expected path line for the tractor to run and acquiring trailer control reference point parameters;

determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter;

determining stress description information of an autonomous truck;

obtaining a corresponding relation between the automatic driving state quantity and a vehicle state quantity of an automatic driving truck;

determining the lateral control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation;

and sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity.

In a second aspect of the embodiments of the present application, there is provided an onboard apparatus of an autonomous truck, applied to an autonomous truck including a tractor and a trailer; the on-vehicle device of an automatic drive truck includes:

the data acquisition unit is used for acquiring an expected path line for the tractor to run and acquiring trailer control reference point parameters;

the automatic driving state quantity determining unit is used for determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter;

the stress description information determining unit is used for determining stress description information of the automatic driving truck;

a correspondence obtaining unit configured to obtain a correspondence between the automatic driving state quantity and a vehicle state quantity of an automatic driving truck;

the transverse control quantity determining unit is used for determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation;

and the control quantity sending unit is used for sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity.

In a third aspect of embodiments of the present application, there is provided an autonomous truck comprising a tractor, a trailer, and an onboard device; the vehicle-mounted device is configured to execute the control method for the autonomous truck according to the first aspect.

In a fourth aspect of embodiments of the present application, there is provided a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements the method of controlling an autonomous truck as described in the first aspect above.

In a fifth aspect of embodiments of the present application, there is provided a computer apparatus comprising a memory, a processor and a computer program stored on the memory and executable on the processor, the processor implementing the method of controlling an autonomous truck according to the first aspect when executing the program.

According to the control method and device for the automatic driving truck and the automatic driving truck, the automatic driving state quantity of the automatic driving truck can be determined according to the expected path line of the running of the tractor and the trailer control reference point parameter; determining stress description information of an autonomous truck; obtaining a corresponding relation between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck; determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation; and sending the transverse control quantity to a steering motor controller of the tractor so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity. According to the control method and the control device for the automatic driving truck, the control precision of the trailer in the automatic driving truck is considered, so that the generated lateral control quantity of the trailer can enable the driving of the trailer to be converged on the expected path line of the driving of the trailer, and the accurate control of the automatic driving truck can be realized.

Drawings

In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings needed to be used in the description of the embodiments or the prior art will be briefly introduced below, it is obvious that the drawings in the following description are only some embodiments of the present application, and for those skilled in the art, other drawings can be obtained according to these drawings without creative efforts.

FIG. 1 is a schematic view of the driving environment of an autonomous truck in an embodiment of the application;

FIG. 2 is a first flowchart of a control method for an autonomous driving truck according to an embodiment of the present disclosure;

FIG. 3 is a second flowchart of a control method for an autonomous driving truck according to an embodiment of the present disclosure;

FIG. 4 is a schematic diagram of a geometrical relationship used in the embodiment of the present application to solve for the position of a trailer control reference point by the position of a tractor control reference point already located;

FIG. 5 is a schematic diagram of a determination method of a trailer position deviation in an embodiment of the present application;

FIG. 6 is a schematic view of a scenario in which an on-board anemometer is installed on an autonomous truck in an embodiment of the present application;

FIG. 7 is a schematic view of a scenario in which road-side anemometers are distributed along a path traveled by an autonomous truck according to an embodiment of the present application;

FIG. 8 is a schematic structural diagram of an onboard device of an automatic driving truck according to an embodiment of the present disclosure;

fig. 9 is a schematic structural diagram of an autonomous truck in an embodiment of the present application.

Detailed Description

The technical solutions in the embodiments of the present application will be described clearly and completely with reference to the drawings in the embodiments of the present application, and it is obvious that the described embodiments are only a part of the embodiments of the present application, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present application.

It should be noted that the terms "first," "second," and the like in the description and claims of this application and in the drawings described above are used for distinguishing between similar elements and not necessarily for describing a particular sequential or chronological order. It should be understood that the data so used may be interchanged under appropriate circumstances such that embodiments of the application described herein may be used. Furthermore, the terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover a non-exclusive inclusion, such that a process, method, system, article, or apparatus that comprises a list of steps or elements is not necessarily limited to those steps or elements expressly listed, but may include other steps or elements not expressly listed or inherent to such process, method, article, or apparatus.

It is worth mentioning that the term "vehicle" is to be interpreted broadly in this application to include any moving object, including for example aircraft, boats, spacecraft, cars, trucks, vans, semitrailers, motorcycles, golf carts, off-road vehicles, warehouse transportation vehicles or agricultural vehicles, as well as vehicles traveling on rails, such as trams or trains, and other rail vehicles. The "vehicle" in the present application may generally include: power systems, sensor systems, control systems, peripheral devices, and computer systems. In other embodiments, the vehicle may include more, fewer, or different systems.

Wherein, the driving system is the system for providing power motion for the vehicle, includes: engine/motor, transmission and wheels/tires, power unit.

The control system may comprise a combination of devices controlling the vehicle and its components, such as a steering unit, a throttle, a braking unit.

The peripheral devices may be devices that allow the vehicle to interact with external sensors, other vehicles, external computing devices, and/or users, such as wireless communication systems, touch screens, microphones, and/or speakers.

In the vehicle based on the above description, for example, the unmanned vehicle is also provided with a sensor system and an unmanned control device.

The sensor system may include a plurality of sensors for sensing information about the environment in which the vehicle is located, and one or more actuators for changing the position and/or orientation of the sensors. The sensor system may include any combination of sensors such as global positioning system sensors, inertial measurement units, radio detection and ranging (RADAR) units, cameras, laser rangefinders, light detection and ranging (LIDAR) units, and/or acoustic sensors; the sensor system may also include sensors (e.g., O) that monitor the vehicle interior systems₂Monitors, fuel gauges, engine thermometers, etc.).

The drone controlling device may include a processor and a memory, the memory having stored therein at least one machine executable instruction, the processor executing the at least one machine executable instruction to implement functions including a map engine, a positioning module, a sensing module, a navigation or routing module, and an automatic control module. The map engine and the positioning module are used for providing map information and positioning information. The sensing module is used for sensing things in the environment where the vehicle is located according to the information acquired by the sensor system and the map information provided by the map engine. And the navigation or path module is used for planning a driving path for the vehicle according to the processing results of the map engine, the positioning module and the sensing module. The automatic control module inputs and analyzes decision information of modules such as a navigation module or a path module and the like and converts the decision information into a control command output to a vehicle control system, and sends the control command to a corresponding component in the vehicle control system through a vehicle-mounted network (for example, an electronic network system in the vehicle, which is realized by CAN (controller area network) bus, local area internet, multimedia directional system transmission and the like), so as to realize automatic control of the vehicle; the automatic control module can also acquire information of each component in the vehicle through a vehicle-mounted network.

In order to make the present application better understood by those skilled in the art, technical terms referred to in the embodiments of the present application are explained as follows:

GPS: global Positioning System, Global Positioning System.

RTK: Real-Time Kinematic, Real-Time dynamic carrier phase difference technology, is a commonly used GPS measurement method.

An IMU: the Inertial Measurement Unit is a device for measuring the three-axis attitude angle (or angular velocity) and acceleration of an object.

CAN: controller Area Network, Controller Area Network bus, is the standard bus of the vehicle computer control system and embedded industrial control local Area Network.

UWB: ultra Wideband, Ultra Wideband communication technology, is a wireless carrier communication technology, utilizes nanosecond to microsecond non-sine wave narrow pulse to transmit data, UWB is used in the early stage to apply to the short-range high-speed data transmission, UWB can be used for doing the accurate indoor location of short-range at present.

MRAC: the Model reference adaptive control algorithm is an adaptive control algorithm for designing an adaptive mechanism to make the dynamic characteristics of a controlled object and a known reference Model as close as possible.

MPC: model Predictive Control, a Model Predictive Control algorithm, is a Control algorithm based on prediction of controlled objects.

In carrying out the embodiments of the present application, as shown in fig. 1, the inventors have discovered that a current autonomous truck 10 generally includes two portions, a tractor 101 and a trailer 102, with the rear portion of the tractor 101 coupled to the front portion of the trailer 102 (e.g., but not limited to, a fifth wheel provided on the tractor 101 and a fifth pin provided on the trailer 102, with the fifth wheel and the fifth pin being cooperatively coupled). In some driving scenarios, such as on the highway of fig. 1, when the autonomous truck 10 is driving on the highway, in order to ensure the driving accuracy of the vehicle, the control reference point of the tractor 101 (typically, the rear axle center of the tractor, which is denoted as point Q in fig. 1) is generally controlled on the center line of the lane (e.g., the center line (dashed line) of the lane in fig. 1), but no consideration is given to the trailer 102, so that under the environment of crosswind disturbance and the like, there may be a certain angle (referred to as trailer angle) between the trailer 102 and the tractor 101 due to the influence of crosswind, that is, the control reference point of the trailer 102 (typically, the rear axle center of the trailer, which is denoted as point G in fig. 1) may not be on the center line of the lane. The risk of the autonomous truck rolling over is therefore likely to occur when the autonomous truck 10 is traveling faster and the load on the trailer 102 is heavier. It can be seen that how to avoid the control of the trailer from being inaccurate is an urgent problem to be solved.

In order to realize accurate control of the autonomous truck and improve the driving safety of the autonomous truck, as shown in fig. 2, the present embodiment provides a control method of the autonomous truck, which is applied to the autonomous truck 10 as shown in fig. 1, where the autonomous truck 10 includes a tractor 101 and a trailer 102; the control method of the automatic driving truck comprises the following steps:

step 201, obtaining an expected path line for the tractor to run, and obtaining trailer control reference point parameters.

And step 202, determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter.

Step 203, determining stress description information of the automatic driving truck.

And step 204, obtaining the corresponding relation between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck.

And step 205, determining the lateral control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation.

And step 206, sending the lateral control quantity to a steering motor controller of the tractor, so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering control quantity.

In order to make the present application better understood by those skilled in the art, a more detailed embodiment is listed below, it should be noted that the embodiment is only one specific embodiment of the present application, and those skilled in the art can also list more specific embodiments without inventive labor, and the embodiment listed in the present application is not limited to the present application. As shown in fig. 3, the present embodiment provides a control method for an autonomous truck, which is applied to the autonomous truck 10 shown in fig. 1, where the autonomous truck 10 includes a tractor 101 and a trailer 102; the control method of the automatic driving truck comprises the following steps:

and 301, obtaining an expected path line for the tractor to run, and obtaining trailer control reference point parameters.

In the field of automatic driving, in order to perform driving control of an automatic driving truck, a desired path needs to be planned first, and therefore, a desired path line for driving the tractor may be directly read from an on-board computer (or an on-board server), or may be obtained from a cloud server, a back-office system, or the like by the on-board computer, but is not limited thereto. In view of the driving safety of the vehicle, the expected path line traveled by the tractor is generally a road center line of the expected path traveled by the tractor, i.e., as shown by the dotted line in fig. 1, for example, but not limited thereto, the expected path line traveled by the tractor may also be set as another traveling path line, for example, a path line set in a closed area such as a harbor area, an industrial park, or the like.

In addition, the trailer control reference point parameter includes a position of the trailer control reference point and may also include a motion orientation of the trailer control reference point. Here, the trailer control reference point may be, but is not limited to, the center of the rear axle of the trailer. The location of the trailer control reference point may be obtained in a number of ways, including but not limited to the following:

first, it should be noted that in the automatic driving truck, the general positioning is performed with respect to the tractor control reference point, for example, sensors such as GPS and IMU are mounted on the tractor, so as to obtain the position of the tractor control reference point. Therefore, by adopting the same principle, a sensor such as a GPS and the like corresponding to the position of the trailer control reference point can be arranged on the trailer, so that the position of the trailer control reference point can be directly located.

In addition, in order to save equipment costs, the position of the trailer control reference point can be calculated from the position of the tractor control reference point already located, by:

obtaining entity data for the autonomous truck, for example as shown in FIG. 4, obtaining the location of the tractor-trailer connection point J relative to the tractor control reference point Q (for the case of FIG. 4, point J and point Q coincide, but are not limited to such, and in other cases, such as when the tractor is larger, point J and point Q may not coincide), the distance of the tractor-trailer connection point J from the trailer control reference point G, and the real-time tractor-trailer angle (i.e., referred to as trailer angle)). For determining the trailer included angle, reference may be made to the patent application publication No. CN108761481A, and details are not described here. In this way, when the position of the tractor control reference point Q is determined, as shown in fig. 4, the position of the trailer control reference point G can be easily calculated from the geometric relationship in the planar rectangular coordinate system (for example, a coordinate system with the position of the tractor control reference point Q as the origin).

In addition, for how to determine the position of the tractor control reference point, the following may be used:

for example, an RTK-based GPS and IMU positioning approach may be employed to determine the position of the tractor control reference points in real time, i.e., integrated positioning by the GPS and IMU on the vehicle.

For another example, at least three UWB base stations may be set in a vehicle driving scene, and a UWB tag may be set in a towing vehicle, so that distance information between the UWB tag and each UWB base station may be obtained through interaction between the UWB tag and the at least three UWB base stations; according to the distance information between the UWB tag and each UWB base station and the position information of at least three UWB base stations, the position information of the UWB tag can be calculated, and the real-time positioning of the position of the tractor control reference point is completed.

For another example, sensors such as GPS, IMU, lidar, and cameras on the vehicle may be used to perform a fusion positioning of the multiple sensors, thereby determining the position of the tractor control reference point in real time.

The specific positioning modes are various and are not listed.

And step 302, determining the automatic driving state quantity of the automatic driving truck according to the expected path line and the trailer control reference point parameter.

The automatic driving state quantity refers to a state quantity related to driving of the automatic driving truck when the automatic driving truck drives according to a desired route line, and includes, for example, a tractor position deviation, a trailer position deviation, a tractor position deviation derivative, a trailer position deviation derivative, a tractor direction angle deviation, a trailer direction angle deviation, and the like.

In an example of the present application, the autonomous driving state quantity of the autonomous truck applied may include a trailer position deviation and a trailer position deviation derivative.

Here, as shown in fig. 5, for step 302, an embodiment of the present application exemplifies one manner, but not limited to this, and those skilled in the art may also enumerate more determination manners of trailer position deviation according to the requirements of a specific algorithm:

for example, the position C1 of a first target point closest to the position G of the trailer control reference point may be obtained from the desired path line (dashed line in fig. 5), and the difference between the position G of the trailer control reference point and the position C1 of the first target point may be determined as the trailer position deviation e_{Hanging rack}. Deviation of trailer position e_{Hanging rack}Derivative calculation is carried out, so that a derivative of the trailer position deviation, for example trailer position deviation e, can be determined_{Hanging rack}Of the first derivative e'_{Hanging rack}And the second derivative e ″)_{Hanging rack}。

Step 303, determining stress description information of the autonomous driving truck by adopting Lagrange mechanics or Newton mechanics.

The stress description information of the automatic driving truck refers to the relation between the stress of the automatic driving truck and the vehicle state function. In the field of control of autonomous trucks, lagrange mechanics or newton mechanics may generally be employed to obtain stress description information for the autonomous truck.

For example, the stress on each wheel of the autonomous truck and the vehicle state quantity may be combined by applying a lagrangian mechanical function to obtain stress description information of the autonomous truck:

f (vehicle _ st ate) when the influence of wind is not considered;

f + F (wind) ═ F (vehicle _ st ate) in consideration of the influence of wind;

here, F denotes the lagrangian abstraction of the autonomous truck; (wind) represents the wind resistance of the autonomous truck; the vehicle _ st ate is a vehicle state quantity of the autonomous truck, for example, a vehicle state quantity such as a vehicle speed, an acceleration, an accelerator opening degree, a steering wheel angle, and the like.

Here, the lagrangian abstraction of the autonomous truck denoted by F is obtained by a lagrangian quantity L, where L is T₁+T₂-V；T₁Is the kinetic energy of the tractor; t is₂Is the trailer kinetic energy; v is potential energy, and in case the autonomous truck is assumed to be moving in a horizontal plane, V can be considered to be 0. Then by lagrange equation:the Lagrange abstraction force Fg in the x-axis direction can be obtained_xn(similarly, the lagrange abstraction of the y-axis can also be obtained by replacing x with y). The x-axis and y-axis may be a vehicle coordinate system.

For another example, a newton's second law of motion mechanical function may be applied to associate the force on each wheel of the autonomous truck with the vehicle state quantity to obtain force description information for the autonomous truck:

f (vehicle _ st ate) when the influence of wind is not considered;

f + F (wind) ═ F (vehicle _ st ate) in consideration of the influence of wind;

here, F represents the autopilot truck tire force; (wind) represents the wind resistance of the autonomous truck; the vehicle _ st ate is a vehicle state quantity of the autonomous truck, for example, a vehicle state quantity such as a vehicle speed, an acceleration, an accelerator opening degree, a steering wheel angle, and the like.

Here, the wind resistance f (wind) of the autonomous truck may be determined in the following two ways, but is not limited thereto.

The first method is as follows: as shown in fig. 6, wherein the autonomous truck wind resistance may include an autonomous truck crosswind resistance; an on-board anemometer 103 may be provided on the autonomous truck 10; a first wind speed and a first wind direction received by the autonomous truck 10 may be obtained by the on-board anemometer 103, and a cross-wind resistance of the autonomous truck may be obtained based on the first wind speed and the first wind direction.

The second method comprises the following steps: as shown in fig. 7, wherein the autonomous truck wind resistance may include an autonomous truck crosswind resistance; a plurality of roadside anemometers 11 may be distributed along the path traveled by the autonomous truck 10. The automatically driven truck may obtain the second wind speed and the second wind direction obtained by the roadside anemometer 11 closest to the position of the tractor control reference point Q or the position of the trailer control reference point G, and may further obtain the crosswind resistance of the automatically driven truck according to the second wind speed and the second wind direction.

Specifically, there are many ways to obtain the cross wind resistance of the vehicle according to the wind speed and the wind direction, for example, refer to the patent publication No. CN204895460U, but not limited thereto.

And step 304, obtaining the corresponding relation between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck.

Here, since the input to the control module of the autonomous truck is information on the desired route during autonomous driving, the vehicle state quantity vehicle _ st ate of the autonomous truck cannot be directly applied, and therefore, it is necessary to shift the vehicle state quantity vehicle _ st ate of the autonomous truck to an autonomous driving state quantity, that is, a state quantity related to travel when the autonomous truck travels along the desired route. When the switching is performed, it is necessary to obtain a correspondence relationship between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck in advance.

And 305, determining the lateral control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck.

This step 305 corresponds to the difference of the above-mentioned stress description information, and there may be the following two ways:

the first method is as follows:

for example, when the force description information is F (drive _ st ate):

wherein, the lateral control quantity of the tractor is the steering wheel angle of the tractor.

Then according to the force description information: f ═ F (vehicle _ st ate) and tire force equation F ═ C_αα is simultaneous, resulting in a dynamic model of the autonomous truck; wherein alpha is a tire slip angle, C_αIs the lateral deflection rigidity; the stress equation F ═ C of the tire_αα can be generally expressed as:wherein, C_αfFor the lateral deflection rigidity, alpha, of the front wheel of the tractor_fIs the side slip angle C of the front wheel of the tractor_αrFor the rear wheel side deflection stiffness, alpha, of the tractor_rIs rear wheel side slip angle C of tractor_αtCornering stiffness, alpha, for trailer tires_tFor the trailer tire slip angle, but not limited to this, the tire force equation may have other expressions according to different vehicles, and the details are not repeated here.

And then the position deviation e of the trailer according to the dynamic model of the automatic driving truck_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}And a correspondence relationship between the automatic driving state quantity and the vehicle state quantity of the automatic driving truck, converting (for example, in an element-changing manner) the vehicle state quantity vehicle _ state of the automatic driving truck in f (vehicle _ state) to f (a, δ) expressed in the automatic driving state quantity; wherein A comprises trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}(ii) a Delta is the steering wheel angle of the tractor.

Processing F ═ F (A, delta) according to a preset control algorithm, such as an MRAC or MPC algorithm, and obtaining the trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}The steering wheel angle δ of the tractor when the preset ideal condition is satisfied is taken as a steering wheel angle result of the tractor.

Among these, ideal conditions include: trailer position deviation e_{Hanging rack}In a first preset range approaching 0, a trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Respectively in a second preset range and a third preset range approaching 0. I.e. the trailer position, is to converge as much as possible on the desired path line.

The second method comprises the following steps:

for example, when the force description information is F + F (wind) ═ F (drive _ st ate):

wherein, the lateral control quantity of the tractor is the steering wheel angle of the tractor.

Then according to the force description information: f + F (wind) and tire stress equation F C_αα is simultaneous, resulting in a dynamic model of the autonomous truck; wherein alpha is a tire slip angle, C_αIs yaw stiffness; the stress equation F ═ C of the tire_αα can be generally expressed as:wherein, C_αfFor the lateral deflection rigidity, alpha, of the front wheel of the tractor_fIs the side slip angle C of the front wheel of the tractor_αrFor the rear wheel side deflection stiffness, alpha, of the tractor_rIs rear wheel side slip angle C of tractor_αtCornering stiffness, alpha, for trailer tires_tFor the trailer tire slip angle, but not limited to this, the tire force equation may have other expressions according to different vehicles, and the details are not repeated here.

And then the position deviation e of the trailer according to the dynamic model of the automatic driving truck_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Converting (for example, in an element-changing manner) the vehicle state quantity vehicle _ st ate of the automatic driving truck in f (vehicle _ state) to f (a, δ) expressed in the automatic driving state quantity, with the correspondence relation; wherein A comprises trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}(ii) a Delta is the steering wheel angle of the tractor.

Processing F + F (win) d ═ F (A, delta) according to a preset control algorithm, such as an MRAC or MPC algorithm, and obtaining the trailer position deviation e_{Hanging rack}Trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}The steering wheel angle δ of the tractor when the preset ideal condition is satisfied is taken as a steering wheel angle result of the tractor.

Among these, ideal conditions include: trailer position deviation e_{Hanging rack}In a first preset range approaching 0, a trailer position deviation derivative e'_{Hanging rack}And e ″)_{Hanging rack}Respectively in a second preset range and a third preset range approaching 0. I.e. the trailer position, is to converge as much as possible on the desired path line.

And step 306, sending the steering wheel angle result of the tractor to a steering motor controller of the tractor, so that the steering motor controller controls a steering motor of the tractor to perform steering action according to the steering wheel angle result of the tractor.

In addition, as shown in fig. 8, the present embodiment also provides an onboard device of an autonomous truck, which is applied to an autonomous truck including a tractor and a trailer; the vehicle-mounted device of the automatic driving truck comprises:

and the data acquisition unit 41 is used for acquiring a desired path line for the tractor to run and acquiring trailer control reference point parameters.

And an automatic driving state quantity determining unit 42 for determining an automatic driving state quantity of the automatic driving truck according to the desired path line and the trailer control reference point parameter.

A stress-description information determining unit 43 for determining stress-description information of the autonomous truck.

A correspondence relation acquisition unit 44 for acquiring a correspondence relation of the automated driving state quantity and the vehicle state quantity of the automated driving truck.

And the transverse control quantity determining unit 45 is used for determining the transverse control quantity of the tractor according to the stress description information, the automatic driving state quantity and the corresponding relation.

And a control amount sending unit 46, configured to send the lateral control amount to a steering motor controller of the tractor, so that the steering motor controller controls a steering motor of the tractor to perform a steering operation according to the steering control amount.

For a specific implementation of the on-board device of the automatically driven truck, reference may be made to the specific implementation of the control method of the automatically driven truck corresponding to fig. 1 to 7, which is not described herein again.

In addition, as shown in fig. 9, the present embodiment also provides an autonomous truck 10, and the autonomous truck 10 includes a tractor 101, a trailer 102, and an onboard device 104. The onboard device 104 may be an onboard computer or server with computing capabilities. The vehicle-mounted device 104 may be provided in the tractor 101, but is not limited thereto. Also provided in the tractor 101 are a steering motor controller 105 and a steering motor 106, the steering motor controller 105 being connected to the steering motor 106 to control the steering motor 106. The in-vehicle device 104 may be used to implement the control method of the autonomous truck corresponding to fig. 1 to 7.

In addition, an embodiment of the present application further provides a computer-readable storage medium, on which a computer program is stored, which, when executed by a processor, implements the method for controlling an autonomous driving truck corresponding to fig. 1 to 7.

In addition, the embodiment of the present application further provides a computer device, which includes a memory, a processor, and a computer program stored on the memory and executable on the processor, and when the processor executes the computer program, the processor implements the control method of the automatic driving truck corresponding to fig. 1 to 7.

According to the control method and the control device, the control precision of the trailer in the automatic driving truck is considered, so that the generated lateral control quantity of the trailer can enable the driving of the trailer to be converged on the expected path line of the driving of the trailer, and the accurate control of the automatic driving truck can be realized. Particularly, when the automatic driving truck runs on a straight road, the tractor and the trailer can converge on an expected path line, and an included angle is not formed between the tractor and the trailer any more, so that the automatic driving truck can avoid the rollover danger when the automatic driving truck runs.

As will be appreciated by one skilled in the art, embodiments of the present application may be provided as a method, apparatus, system, or computer program product. Accordingly, the present application may take the form of an entirely hardware embodiment, an entirely software embodiment or an embodiment combining software and hardware aspects. Furthermore, the present application may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, and the like) having computer-usable program code embodied therein.

The present application is described with reference to flowchart illustrations and/or block diagrams of methods, apparatus (systems), and computer program products according to embodiments of the application. It will be understood that each flow and/or block of the flow diagrams and/or block diagrams, and combinations of flows and/or blocks in the flow diagrams and/or block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general purpose computer, special purpose computer, embedded processor, or other programmable data processing apparatus to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing apparatus, create means for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.

These computer program instructions may also be stored in a computer-readable memory that can direct a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory produce an article of manufacture including instruction means which implement the function specified in the flowchart flow or flows and/or block diagram block or blocks.

These computer program instructions may also be loaded onto a computer or other programmable data processing apparatus to cause a series of operational steps to be performed on the computer or other programmable apparatus to produce a computer implemented process such that the instructions which execute on the computer or other programmable apparatus provide steps for implementing the functions specified in the flowchart flow or flows and/or block diagram block or blocks.

The principle and the implementation mode of the present application are explained by applying specific embodiments in the present application, and the description of the above embodiments is only used to help understanding the method and the core idea of the present application; meanwhile, for a person skilled in the art, according to the idea of the present application, there may be variations in the specific embodiments and the application scope, and in summary, the content of the present specification should not be construed as a limitation to the present application.