Unmanned equipment control method, device, storage medium and electronic equipment
By calculating the deviation of equipment spacing in the unmanned equipment formation and determining the target control amount to offset the impact of delay, the problem of control delay of unmanned driving systems in the prior art is solved and road traffic efficiency is improved.
Patent Information
- Application Number
- CN202211236512.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-10-10
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-10-10
AI Technical Summary
The existing collaborative formation control method does not consider the impact of perceived delay, communication delay and control delay on the unmanned driving system, resulting in the inability to effectively shorten the follow-up distance between unmanned driving equipment and reduce road traffic efficiency.
By determining the actual and expected spacing deviation between the equipment to be controlled in the unmanned equipment formation and its surrounding equipment, the target control amount is calculated, which is used to control the unmanned equipment to offset the impact of delay and improve control accuracy and traffic efficiency.
While ensuring safety, the accuracy of unmanned equipment spacing and road traffic efficiency are improved by offsetting the impact of perception and communication delays.
Smart Images

Figure CN117908527B_ABST
Abstract
Description
Technical Field
[0001] This specification relates to the field of autonomous driving, and in particular to an unmanned equipment control method, device, storage medium and electronic device. Background Art
[0002] At present, the cooperative adaptive cruise system is an unmanned driving system used to control unmanned equipment formations. During the driving process of the unmanned equipment, the cooperative adaptive cruise system can control the longitudinal motion state of each unmanned driving device in the unmanned driving device formation. While ensuring safety, it shortens the following distance between unmanned driving devices to achieve the purpose of improving road traffic efficiency. Summary of the invention
[0003] This specification provides an unmanned equipment control method and device to partially solve the above-mentioned problems existing in the prior art.
[0004] This manual adopts the following technical solutions:
[0005] This specification provides an unmanned equipment control method, including:
[0006] Determine an unmanned device to be controlled in an unmanned device formation as a first device, and unmanned devices located around the first device in the unmanned device formation as second devices;
[0007] Obtaining an actual distance between a position of the first device at a current moment and a position of the second device at the specified historical moment, and determining an expected distance between the first device at the current moment and the second device at the specified historical moment;
[0008] Based on the deviation between the actual spacing and the expected spacing, and the determined control amount of the second device at the specified historical moment, the control amount for the first device at the current moment is determined as the target control amount, and the first device is controlled according to the target control amount.
[0009] Optionally, obtaining an actual distance between a position of the first device at a current moment and a position of the second device at a specified historical moment specifically includes:
[0010] According to the acquired driving data of the first device and the driving data of the second device, an actual distance between a position of the first device at a current moment and a position of the second device at a specified historical moment is determined.
[0011] Optionally, the driving data includes: state data and control data; the state data includes: the distance between each unmanned device in the unmanned device formation, the position data of the unmanned device, the speed of the unmanned device, and the acceleration of the unmanned device; the control data includes: the control amount of the unmanned device controlling its own driving;
[0012] Acquiring the driving data of the first device and the second device specifically includes:
[0013] By means of a sensor mounted on the first device, state data of the first device and the second device during driving are collected and stored;
[0014] The control data sent by the second device and used for controlling the second device itself is obtained through the communication module mounted on the first device.
[0015] Optionally, the time length from the specified historical moment to the current moment is not less than the maximum value of the communication delay of the second device sending control data through the communication module and the perception delay of the first device collecting data through the sensor.
[0016] Optionally, obtaining an actual distance between a position of the first device at a current moment and a position of the second device at the specified historical moment specifically includes:
[0017] Based on the position of the first device at the current moment, the position of the second device at the specified historical moment and the preset device length, determine the actual distance between the position of the front end of the first device at the current moment and the position of the rear end of the second device at the specified historical moment.
[0018] Optionally, determining an expected distance between the first device at a current moment and the second device at the specified historical moment specifically includes:
[0019] Determine, based on the distance traveled by the first device at the current moment within the preset buffer time at the speed perceived by the first device at the current moment, and the preset minimum distance between unmanned devices, a basic distance between the first device at the current moment and the second device at the specified historical moment;
[0020] determining a corrected distance based on a distance traveled by the second device from the specified historical time to the current time at the speed perceived at the specified historical moment;
[0021] The expected spacing is determined according to the basic spacing and the corrected distance.
[0022] Optionally, determining the control amount for the first device at the current moment according to the deviation between the actual spacing and the expected spacing and the determined control amount of the second device at the specified historical moment specifically includes:
[0023] determining an intermediate control amount according to the deviation and the determined control amount of the second device at the specified historical moment;
[0024] The target control amount is determined according to the intermediate control amount and a preset buffering time.
[0025] Optionally, determining the control amount of the second device at the specified historical moment specifically includes:
[0026] Determine the control amount of the first device at the specified historical moment, obtain a first proportional control parameter and a first differential control parameter corresponding to the first device, and obtain a second proportional control parameter and a second differential control parameter corresponding to the second device;
[0027] Determine a weighted sum value obtained by weighting the control amount of the first device at the specified historical moment by the first proportional control parameter and by weighting the set order control amount of the first device at the specified historical moment by the first differential control parameter as a first sum value, and determine a weighted sum value obtained by weighting the control amount of the second device at the specified historical moment by the second proportional control parameter and by weighting the set order control amount of the second device at the specified historical moment by the second differential control parameter as a second sum value;
[0028] The control amount of the second device at the specified historical moment is determined with the first sum value matching the second sum value as a constraint condition.
[0029] Optionally, after the target control amount is determined, the stored driving data of the second device before the specified historical moment is deleted.
[0030] This specification provides an unmanned equipment control device, including:
[0031] A device determination module, used to determine an unmanned device to be controlled in an unmanned device formation as a first device, and unmanned devices located around the first device in the unmanned device formation as a second device;
[0032] an acquisition module, configured to acquire an actual distance between a position of the first device at a current moment and a position of the second device at a specified historical moment, and determine an expected distance between the first device at the current moment and the second device at the specified historical moment;
[0033] A control module is used to determine the control amount for the first device at the current moment as a target control amount based on the deviation between the actual spacing and the expected spacing and the determined control amount of the second device at the specified historical moment, and control the first device according to the target control amount.
[0034] This specification provides a computer-readable storage medium, which stores a computer program. When the computer program is executed by a processor, the above-mentioned unmanned equipment control method is implemented.
[0035] This specification provides an unmanned driving device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned unmanned driving device control method when executing the program.
[0036] At least one of the above technical solutions adopted in this specification can achieve the following beneficial effects:
[0037] In the unmanned equipment control method provided in this specification, for the first equipment to be controlled in the unmanned equipment formation, the actual distance between the current position of the first equipment and the position of the second equipment located around the first equipment in the unmanned equipment formation at the specified historical moment can be obtained, and the expected distance between the first equipment at the current moment and the second equipment at the specified historical moment can be determined. According to the deviation between the predicted actual distance and the expected distance, and the control amount of the second equipment at the specified historical moment, the control amount for the first equipment at the current moment is determined, and the first equipment is controlled accordingly.
[0038] It can be seen from the above method that this method predicts the actual distance between the first device and the second device through the driving data of the first device and the second device. Then, through the deviation between the actual distance between the first device and the second device and the expected distance, and the control amount of the second device at a specified historical moment, the target control amount of the first device is finally determined, and the first device is controlled accordingly. Because the determined driving data and status data are affected by perception delay and communication delay regardless of the current moment or the specified historical moment, the method provided in this application actually offsets the effects of perception delay and communication delay by determining the deviation between the above actual distance and the expected distance, thereby improving the accuracy of determining the target control amount, and improving the traffic efficiency of the road while ensuring safety. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] The drawings described herein are used to provide a further understanding of this specification and constitute a part of this specification. The illustrative embodiments and descriptions of this specification are used to explain this specification and do not constitute an improper limitation on this specification. In the drawings:
[0040] Figure 1 A flowchart of an unmanned equipment control method in this specification;
[0041] Figure 2 A schematic diagram of an unmanned vehicle fleet cooperative cruising provided in this manual;
[0042] Figure 3 A schematic diagram of an unmanned equipment control device provided in this manual;
[0043] Figure 4 The corresponding Figure 1 Schematic diagram of electronic equipment. DETAILED DESCRIPTION
[0044] In order to make the purpose, technical solutions and advantages of this specification more clear, the technical solutions of this specification will be clearly and completely described below in combination with the specific embodiments of this specification and the corresponding drawings. Obviously, the described embodiments are only part of the embodiments of this specification, not all of them. Based on the embodiments in this specification, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this specification.
[0045] The collaborative formation control method in the prior art does not take into account the delay problem of each system, that is, it does not take into account the impact of perception delay, communication delay, and control delay on the unmanned driving system's control of unmanned driving equipment. In order to ensure the safety of unmanned driving equipment, the unmanned driving system needs to control the unmanned driving equipment to maintain a large following distance, which reduces the traffic capacity of the road and fails to achieve the purpose of improving road traffic efficiency.
[0046] The technical solutions provided by the embodiments of this specification are described in detail below in conjunction with the accompanying drawings.
[0047] Figure 1 The following is a flow chart of an unmanned equipment control method in this specification, which specifically includes the following steps:
[0048] S100: Determine an unmanned device to be controlled in an unmanned device formation as a first device, and unmanned devices located around the first device in the unmanned device formation as second devices.
[0049] This specification provides an unmanned equipment control method, and the unmanned equipment can be an unmanned vehicle, a drone, or other unmanned equipment, and this specification does not limit this. In the embodiment of this specification, the first device is an unmanned vehicle to be controlled in the unmanned equipment formation, and the unmanned vehicle can include an automatic driving vehicle and a vehicle with an assisted driving function. In one embodiment, the unmanned vehicle can be a delivery vehicle used in the delivery field.
[0050] The execution subject of the unmanned equipment control method provided in this specification can be the first device itself, or another terminal device or server that communicates with the first device. When the execution subject is a terminal device, it can be any existing terminal device, such as a desktop computer, a laptop computer, etc., and when the execution subject is a server, it can also be a cluster server or a distributed server, etc., and this specification does not limit this. For the convenience of description, the unmanned equipment control method provided in this specification is described below by taking the first device itself as the execution subject as an example.
[0051] In addition, the first device may include a control system and an execution system, wherein the control system uses the unmanned device control method proposed in the embodiment of this specification to determine the target control amount for the first device, and sends the target control amount to the execution system (such as brakes, throttle, etc.), and the execution system can control according to the received target control amount, for example, control the throttle to 80% opening. At this point, it can also be considered that the execution subject of the embodiment of this specification is the control system of the first device.
[0052] The unmanned device control method provided in this specification aims to control each unmanned device in the unmanned device formation to move at a safe distance from the unmanned device in front of it. Generally speaking, the first device needs to maintain a safe distance from the unmanned device in front of it during movement. Therefore, the second device can be an unmanned device in the same unmanned device formation as the first device, and the unmanned device in front of the first device, such as Figure 2 shown.
[0053] Figure 2 A schematic diagram of cooperative cruising of an unmanned vehicle fleet provided in this manual.
[0054] exist Figure 2 In the process, each unmanned vehicle (i.e., unmanned equipment) can form an unmanned vehicle formation and travel in the same direction and the same lane. The unmanned vehicles can communicate with each other in the vehicle. That is, for any unmanned vehicle in the formation, the unmanned vehicle can send the driving data collected by its own on-board radar to other unmanned vehicles in the queue. After obtaining the driving data sent by other unmanned vehicles, each unmanned vehicle can combine its own driving data to obtain the control amount for controlling itself, so as to control itself through the control amount. In this way, any two adjacent unmanned vehicles in the formation can maintain a relatively stable distance to ensure the driving safety of each unmanned vehicle in the queue.
[0055] It is worth noting that in the above-mentioned unmanned vehicle formation, any unmanned vehicle can be the first device, and for any unmanned vehicle, if the unmanned vehicle is the first device, the remaining unmanned vehicles in the unmanned vehicle formation can be regarded as the second device. Of course, considering that in actual applications, unmanned equipment should pay more attention to the unmanned equipment adjacent to it in the above-mentioned formation during driving, then the second device can refer to the device located before the first device in the unmanned equipment formation, or it can be the device located after the first device in the unmanned equipment formation. Preferably, the second device can be the unmanned equipment located in front of the first device in the unmanned equipment formation.
[0056] It should be noted that since the first device usually needs to change lanes due to trajectory planning, the second device can also be an unmanned device that is traveling in a different lane from the first device and is located ahead of the first device in the unmanned device formation. This manual does not impose any restrictions on this.
[0057] S102: Obtain an actual distance between the position of the first device at the current device and the position of the second device at the specified historical moment, and determine an expected distance between the first device at the current moment and the second device at the specified historical moment.
[0058] S104: Based on the deviation between the actual spacing and the expected spacing, and the determined control amount of the second device at the specified historical moment, determine the control amount for the first device at the current moment as the target control amount, and control the first device according to the target control amount.
[0059] In the embodiment of the present specification, a collection device is mounted on the first device to obtain the driving data of the first device itself and the driving data of the second device.
[0060] The driving data at least includes: the state data and control data of the unmanned equipment. The state data mainly includes: the position data of the unmanned equipment, the distance between the unmanned equipment in the unmanned equipment formation, the speed of the unmanned equipment (including the speed of the first equipment itself and the speed of the second equipment), and the acceleration of the unmanned equipment. The control data mainly includes: the control amount of the unmanned equipment to control its own driving.
[0061] Specifically, taking the unmanned device as an unmanned vehicle as an example, the first device is equipped with a sensor, such as a camera, a laser radar, a Doppler radar, etc. The first device can use the radar mounted thereon to generate a fixed frequency f s Collect the position p of the vehicle (first device) i (t-δ s,i ), vehicle spacing d i (t-δs,i ), vehicle speed v i (t-δ s,i ), the front vehicle (second device) speed v i-1 (t-δ s,i ), and store it in the storage module of the first device, or upload it to a server that can communicate with the first device, which is not described in this description. Since the radar on the first device usually operates at a certain acquisition frequency, such as collecting data at a frequency of 10Hz to 20Hz, there is usually a delay when the radar senses the status data of the unmanned device, that is, the perception delay. Therefore, the status data of the unmanned device obtained by the radar is actually δ s,i The data from seconds ago, where δ s It can be used to represent the perceived delay, and i is used to represent the first device.
[0062] Based on the above description, the first device can obtain the position of the first device at the current moment through the sensor mounted on itself. Furthermore, due to the perception delay, the position of the first device at the current moment obtained is actually the position of the first device at δ s,i The position seconds ago.
[0063] This manual takes into account the perception delay of sensors on unmanned equipment when acquiring data. Therefore, the state data acquired at each current moment (time t) is actually t-δ s,i The status data corresponding to the moment.
[0064] The first device is equipped with a communication module, for example, the vehicle-to-vehicle communication with the second device is realized through the Internet of Vehicles, V2X and other technologies. The first device can obtain the control data sent by the second device for controlling the second device itself through the communication module installed on its device, and the control data includes: the control amount of the unmanned device to control its own driving. Among them, in one embodiment of the present specification, the control amount may only include the longitudinal control amount for controlling the unmanned device in the longitudinal direction. The longitudinal control amount includes brakes and throttles. Of course, for unmanned vehicles that need to set gears to achieve control, the longitudinal control amount may also include gears.
[0065] Specifically, the first device can obtain the acceleration a of the preceding vehicle (the second device) through the communication module. i-1 (t-δ s,i-1 -δ c,i ) and the longitudinal control amount u of the preceding vehicle i-1 (t-δ c,i), and store it in the storage module of the first device, or upload it to a server that can communicate with the first device, which is not explained in this description. Since the communication module on the first device communicates at a certain operating frequency, such as 10Hz to 16Hz, the communication module also has a delay, that is, communication delay. The longitudinal control amount of the unmanned device obtained by the first device through the communication module is actually δ c,i Data from seconds ago.
[0066] As for the acceleration of the second device, since the second device senses its own acceleration through its own sensor (such as a camera, a laser radar, a Doppler radar, etc.), there will also be the above-mentioned perception delay. Therefore, when the second device obtains its own acceleration and then sends the acceleration to the first device through the communication module, this process will be affected by the communication delay and the perception delay of the second device itself, so that the acceleration of the second device obtained by the first device is actually δ s,i-1 +δ c,i The data from seconds ago. Among them, δ c is used to represent the communication delay, and i-1 can be used to represent the second device.
[0067] In addition, the unmanned equipment control method provided in this specification is based on a proportional-integral-differential control system, so the first device can also obtain the control parameter k of the second device sent by the second device through the communication module. p,i-1 , k d,i-1 , where k p,i-1 is the proportional control parameter of the second device, k d,i-1 is the differential control parameter of the second device. Correspondingly, k p,i Can be used to represent the proportional control parameter of the first device, k d,i Can be used to represent the derivative control parameter of the first device.
[0068] In the embodiments of this specification, due to the existence of perception delay and communication delay, the first device cannot accurately collect the driving data of the first device and the driving data of the second device at each moment during the driving process. In order to improve the accuracy, this specification can use data linear interpolation to calculate the position of the second device at a specified historical moment.
[0069] The embodiment of this specification shows a method for determining the second position:
[0070] Determine each adjacent moment within a preset range of the specified historical moment, and fit the relationship between the position and time of the second device by interpolation based on the saved driving data of the second device at each adjacent moment as the position function of the second device. Then, based on the position function of the second device and the specified historical moment, determine the position of the second device at the specified historical moment.
[0071] In one embodiment of the present specification, the position function can be fitted only based on the stored positions of the second device at the two most recent acquisition moments. Of course, in order to further fit a more accurate position function, multiple sets of data can be used for fitting.
[0072] Specifically, the control system of the first device can calculate the second device in β by using the pre-stored driving data of the first device and the driving data of the second device through the data linear interpolation method. i The position of the second device seconds ago, that is, the position of the second device at the specified historical moment p i-1 (t-δ s,i-1 -β i ), and the velocity v of the second device at the specified historical moment i-1 (t-δ s,i-1 -β i ), acceleration a i-1 (t-δ s,i-1 -β i ), control quantity u i-1 (t-β i ).
[0073] Among them, β i is a constant used to characterize the time from the specified historical moment to the specified moment, which is not less than the maximum value of the communication delay of the second device sending control data through the communication module and the collection delay when the first device collects data through the sensor, that is, β i ≥max{δ c,i,max ,δ s,i In the embodiments of this specification, the influence caused by the acquisition delay and the communication delay can be ignored through the above value range.
[0074] Each unmanned device in the unmanned device formation may be a device of the same model, that is, the hardware parameters such as the device length of each unmanned device may be the same.
[0075] Based on the above conditions, in the embodiment of the present specification, the control system of the first device can determine the actual distance between the first device and the second device during driving to determine the longitudinal control amount for the first device.
[0076] Specifically, first, without considering the above communication delay and perception delay, the actual distance between the first device and the second device should be: p i-1 (t)-p i (t)-L i , where L i is the length of the unmanned device. Therefore, what is actually represented here is the distance between the front end of the first device and the rear end of the second device.
[0077] Considering only the above perceived delay, the actual distance between the first device and the second device should be: p i-1 (t-δ s,i-1 -β i )-p i (t-δ s,i )-L i Similarly, the actual spacing here represents the distance between the front end of the first device and the rear end of the second device taking into account the perceived delay.
[0078] On this basis, the desired distance between the first device and the second device can be determined assuming that the second device is stationary. For details, refer to the following formula:
[0079] d r,i (t) = v i (t-δ s,i )×α i +d min
[0080] Among them, v i (t) is the speed of the first device at the current moment, α i It is used to indicate the reaction time allowed when the first device moves from the front end of its own device to the rear end of the second device. Therefore, it can be called the buffer time. min is the distance between unmanned devices in the unmanned device formation in a stationary state (when parked), that is, the parking clearance. In order to ensure the safety of the unmanned devices during driving, α i >0,d min >0.
[0081] Since the above formula actually represents the expected distance between the second device and the second time when the second device is not moving, it can be called the basic distance.
[0082] However, in actual applications, the first device and the second device are in the same formation, so the first device and the second device are usually in a coordinated cruising state. Therefore, considering that the second device is also traveling, the desired distance between the first device and the second device can be expressed by the following formula:
[0083]
[0084] For the second device in the past [t-δ s,i-1 -β i ,t-δ s,i-1 ] This distance can correct the above basic distance, so it can be called the corrected distance.
[0085] It can be seen that by correcting the above basic distance through the correction distance, the actual expected distance between the first device and the second device can be determined.
[0086] On this basis, the first device predicts the actual distance between the position of the first device at the current moment and the position of the second device at the specified historical moment. For details, refer to the following formula:
[0087] p i-1 (t-δ s,i-1 -β i )-p i (t-δ s,i )-L i ,
[0088] It can be seen here that the actual spacing determined at this time is affected by the perceived delay.
[0089] Further, the first device may determine a deviation between an actual spacing obtained by the above formula and a determined expected spacing corresponding to the actual spacing, with specific reference to the following formula:
[0090]
[0091] Then, since in the above formula, p i-1 (t-δ s,i-1 -β i )-p i (t-δ s,i )-L i and The second device is considered in the past [t-δ s,i-1 -β i ,t-δ s,i-1 ], so the second device has traveled a distance in the past [t-δ s,i-1 -β i ,t-δ s,i-1 ] can be removed from these two terms, resulting in the following simplified formula:
[0092] e i (t) = [pi-1 (t-β i )-p i (t)-L i ]-[v i (t)×α i +d min ]
[0093] It can be seen from here that in this way, the influence of the perceived delay can be eliminated, so that the control amount used to control the first device can be determined in the subsequent process through the known variables.
[0094] It should be pointed out that the above formula only considers the perception delay, but in fact the acquisition delay mentioned above should also be considered, so the acquisition delay also needs to be added to the above formula. However, since both the actual spacing and the expected spacing are affected by the acquisition delay and the perception delay, the above method can eliminate the influence of the perception delay and the acquisition delay, thereby ensuring that the control amount of the first device determined subsequently will not be affected by the acquisition delay and the perception delay.
[0095] Furthermore, since the first device and the second device can be devices of the same specifications, and, in the process of traveling through the above-mentioned formation, it is actually expected that the unmanned devices can maintain a relatively stable distance between each other for coordinated cruising, so this can be used as a constraint condition to determine the control amount of the second device at a specified historical moment.
[0096] Specifically, the first device can determine the control amount of the first device at a specified historical moment, obtain the first proportional control parameter and the first differential control parameter corresponding to the first device, and obtain the second proportional control parameter and the second differential control parameter corresponding to the second device. Since the first device can store its own data, the control amount, the first proportional control parameter and the first differential control parameter of the first device at a specified historical moment can be obtained from the first device itself. The second proportional control parameter and the second differential control parameter can be obtained from the second device through a communication connection with the second device.
[0097] Further, the first device may determine the weighted sum of the weighted control amount of the second device at a specified historical moment by the first proportional control parameter and the weighted control amount of the set order of the second device at a specified historical moment by the first differential control parameter as the first sum, and determine the weighted sum of the weighted control amount of the first device at a specified historical moment by the second proportional control parameter and the weighted control amount of the set order of the first device at a specified historical moment by the second differential control parameter as the second sum. The set order mentioned here may be determined according to actual needs. In the embodiments of this specification, the control amount of the set order may refer to the first-order value of the control amount.
[0098] Finally, the first device can use the matching of the first sum value and the second sum value as a constraint condition to determine the control amount of the second device at a specified historical moment. For details, please refer to the following formula:
[0099]
[0100] Among them, r i (t) is used to represent the control amount of the first device at the current moment, u i-1 (t) is used to represent the control amount of the second device at the current moment. p,i Used to represent the first proportional control parameter, k d,i Used to represent the first differential control parameter, k p,i-1 Used to represent the second proportional control parameter, k d,i-1 Used to represent the second derivative control parameter.
[0101] so, can be used to represent the second sum mentioned above, and
[0102] In can be used to represent the first and value mentioned above.
[0103] After determining the control amount of the second device at the specified historical moment, the first device can determine the control amount for the first device at the current moment based on the deviation between the actual spacing and the expected spacing corresponding to the actual spacing, and the control amount of the second device at the specified historical moment.
[0104] Specifically, we can introduce the formula Then the intermediate control quantity is smoothed by first order to obtain the longitudinal control quantity, where the formula for obtaining the control quantity of the first device at the current moment is: i (t) = u i (t)+α i ×u i (t).
[0105] In the above formula, q i (t) is the intermediate control quantity, kp and k d are the proportional term coefficient and the differential term coefficient respectively, and must satisfy k p >0,k d >0,u i (t) is the longitudinal control amount, that is, the target control amount.
[0106] In addition, after determining the above-mentioned actual spacing, this specification exemplarily provides the following method for determining the target control amount. For example, a difference conversion function may be pre-constructed, and the difference conversion function is used to characterize the conversion relationship between the target control amount and the difference. According to the difference between the actual spacing and the reference spacing, the difference conversion function is used to obtain the determined target control amount. For example only, the difference conversion function may be composed of a proportional term, a differential term, and a constant term. The difference conversion function may also include an integral term. In one embodiment of this specification, the coefficients of each term in the difference conversion function may be a predetermined constant.
[0107] based on Figure 1 The unmanned equipment control method shown, for the first equipment to be controlled in the unmanned equipment formation, determines the position of the first equipment at the current moment according to the acquired driving data thereof, and determines the second position of the second equipment at a specified historical moment according to the acquired driving data of the second equipment around the first equipment. The actual distance between the current position of the first equipment and the position of the second equipment at a specified historical moment is determined by the first position and the second position. The control amount for the first equipment at the current moment is determined according to the deviation between the actual distance and the expected distance, and the control amount of the second equipment at the specified historical moment, and the first equipment is controlled accordingly.
[0108] Since the determined driving data and status data are affected by perception delay and communication delay regardless of the current moment or the specified historical moment, the method provided in the embodiment of the present application actually offsets the effects of perception delay and communication delay by determining the deviation between the above-mentioned actual spacing and the expected spacing, thereby improving the accuracy of determining the target control amount and improving the road traffic efficiency while ensuring safety.
[0109] In order to save the local storage space of the first device in the embodiment of the present application, the first device can delete the data at a time less than t-β. i -δ s,i-1 That is, the driving data of the second device stored before the specified historical moment can be deleted. Therefore, the data stored in the first device will actually change continuously. As the first device continues to drive, new driving data is continuously written into the storage space of the first device. At the same time, the first device also continuously deletes data that is too old from the storage space.
[0110] The above is an unmanned equipment control method provided by one or more embodiments of this specification. Based on the same idea, this specification also provides a corresponding unmanned equipment control device, such as Figure 3 shown.
[0111] Figure 3 A schematic diagram of an unmanned equipment control device provided for this specification specifically includes:
[0112] The device determination module 301 is used to determine the unmanned device to be controlled in the unmanned device formation as the first device, and the unmanned devices around the first device as the second device;
[0113] An acquisition module 302 is used to acquire an actual distance between a position of the first device at a current moment and a position of the second device at a specified historical moment, and to determine an expected distance between the first device at the current moment and the second device at the specified historical moment;
[0114] The control module 303 is used to determine the control amount for the first device at the current moment as the target control amount based on the deviation between the actual spacing and the expected spacing and the determined control amount of the second device at the specified historical moment, and control the first device according to the target control amount.
[0115] Optionally, the acquisition module 302 is specifically used to determine the actual distance between the position of the first device at a current moment and the position of the second device at a specified historical moment based on the acquired driving data of the first device and the driving data of the second device.
[0116] Optionally, the driving data includes: state data and control data; the state data includes: the distance between each unmanned device in the unmanned device formation, the position data of the unmanned device, the speed of the unmanned device, and the acceleration of the unmanned device; the control data includes: the control amount of the unmanned device controlling its own driving;
[0117] The acquisition module 302 is specifically used to collect and store status data of the first device and the second device during driving through the sensor installed on the first device; and to obtain control data sent by the second device for controlling the second device itself through the communication module installed on the first device.
[0118] Optionally, the time length from the specified historical moment to the current moment is not less than the maximum value of the communication delay of the second device sending control data through the communication module and the perception delay of the first device collecting data through the sensor.
[0119] Optionally, the acquisition module 302 is specifically used to determine the actual distance between the position of the front end of the first device at the current moment and the position of the tail end of the second device at the specified historical moment based on the position of the first device at the current moment, the position of the second device at the specified historical moment and a preset device length.
[0120] Optionally, the acquisition module 302 is specifically used to determine the basic distance between the first device at the current moment and the second device at the specified historical moment based on the distance traveled by the first device at the speed perceived at the current moment within a preset buffer time, and a preset minimum distance between unmanned devices; determine a corrected distance based on the distance traveled by the second device from the specified historical time to the current time at the speed perceived by the second device at the specified historical moment; and determine the expected distance based on the basic distance and the corrected distance.
[0121] Optionally, the control module 303 is specifically used to determine an intermediate control amount based on the deviation and the determined control amount of the second device at the specified historical moment; and determine the target control amount based on the intermediate control amount and a preset buffer time.
[0122] Optionally, the control module 303 is also used to determine the control amount of the first device at the specified historical moment, obtain the first proportional control parameter and the first differential control parameter corresponding to the first device, and obtain the second proportional control parameter and the second differential control parameter corresponding to the second device; determine the weighted sum of the control amount of the second device at the specified historical moment weighted by the first proportional control parameter and the set order control amount of the second device at the specified historical moment weighted by the first differential control parameter as the first sum, and determine the weighted sum of the control amount of the first device at the specified historical moment weighted by the second proportional control parameter and the set order control amount of the first device at the specified historical moment weighted by the second differential control parameter as the second sum; determine the control amount of the second device at the specified historical moment with the first sum matching the second sum as a constraint.
[0123] Optionally, the device further comprises:
[0124] The deleting module 304 is used to delete the stored driving data of the second device before the specified historical moment after the device determines the target control amount.
[0125] It should be noted that all actions of acquiring signals, information or data in this application are carried out in compliance with the relevant data protection laws and policies of the country where they are located, and with the authorization given by the owner of the corresponding device.
[0126] This specification also provides a computer-readable storage medium, which stores a computer program, which can be used to execute the above Figure 1 An unmanned equipment control method is provided.
[0127] This manual also provides Figure 4 The schematic structure diagram of the electronic device shown in FIG. Figure 4 As mentioned above, at the hardware level, the unmanned driving device includes a processor, an internal bus, a network interface, a memory, and a non-volatile memory, and may also include other hardware required for the business. The processor reads the corresponding computer program from the non-volatile memory into the memory and then runs it to achieve the above Figure 1 Of course, in addition to the software implementation, this specification does not exclude other implementations, such as logic devices or a combination of software and hardware, etc., that is, the execution subject of the following processing flow is not limited to each logic unit, but can also be hardware or logic devices.
[0128] In the 1990s, improvements to a technology could be clearly distinguished as hardware improvements (for example, improvements to the circuit structure of diodes, transistors, switches, etc.) or software improvements (improvements to the method flow). However, with the development of technology, many improvements to the method flow today can be regarded as direct improvements to the hardware circuit structure. Designers almost always obtain the corresponding hardware circuit structure by programming the improved method flow into the hardware circuit. Therefore, it cannot be said that an improvement in a method flow cannot be implemented using a hardware entity module. For example, a programmable logic device (PLD) (such as a field programmable gate array (FPGA)) is such an integrated circuit whose logical function is determined by the user's programming of the device. Designers can "integrate" a digital system on a PLD by programming it themselves, without having to ask a chip manufacturer to design and produce a dedicated integrated circuit chip. Moreover, nowadays, instead of manually making integrated circuit chips, this kind of programming is mostly implemented by "logic compiler" software, which is similar to the software compiler used when developing and writing programs, and the original code before compilation must also be written in a specific programming language, which is called hardware description language (HDL). There is not only one HDL, but many kinds, such as ABEL (Advanced Boolean Expression Language), AHDL (Altera Hardware Description Language), Confluence, CUPL (Cornell University Programming Language), HDCal, JHDL (Java Hardware Description Language), Lava, Lola, MyHDL, PALASM, RHDL (Ruby Hardware Description Language), etc. The most commonly used ones are VHDL (Very-High-Speed Integrated Circuit Hardware Description Language) and Verilog. Those skilled in the art should also know that it is only necessary to program the method flow slightly in the above-mentioned hardware description languages and program it into the integrated circuit, and then it is easy to obtain the hardware circuit that implements the logic method flow.
[0129] The controller can be implemented in any appropriate manner, for example, the controller can take the form of a microprocessor or processor and a computer-readable medium storing a computer-readable program code (such as software or firmware) that can be executed by the (micro)processor, a logic gate, a switch, an application-specific integrated circuit (ASIC), a programmable logic controller, and an embedded microcontroller. Examples of controllers include, but are not limited to, the following microcontrollers: ARC 625D, Atmel AT91SAM, Microchip PIC18F26K20, and Silicone Labs C8051F320. The memory controller can also be implemented as part of the control logic of the memory. Those skilled in the art also know that in addition to implementing the controller in a purely computer-readable program code manner, the controller can be implemented in the form of a logic gate, a switch, an application-specific integrated circuit, a programmable logic controller, and an embedded microcontroller by logically programming the method steps. Therefore, this controller can be considered as a hardware component, and the devices included therein for implementing various functions can also be regarded as structures within the hardware component. Or even, the devices for implementing various functions can be regarded as both software modules for implementing the method and structures within the hardware component.
[0130] The systems, devices, modules or units described in the above embodiments may be implemented by computer chips or entities, or by products with certain functions. A typical implementation device is a computer. Specifically, the computer may be, for example, a personal computer, a laptop computer, a cellular phone, a camera phone, a smart phone, a personal digital assistant, a media player, a navigation device, an email device, a game console, a tablet computer, a wearable device, or a combination of any of these devices.
[0131] For the convenience of description, the above device is described in various units according to their functions. Of course, when implementing this specification, the functions of each unit can be implemented in the same or multiple software and / or hardware.
[0132] Those skilled in the art will appreciate that embodiments of the present invention may be provided as methods, systems, or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0133] The present invention is described with reference to flowcharts and / or block diagrams of methods, devices (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0134] These computer program instructions may also be stored in a computer readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer readable memory produce an article of manufacture including an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0135] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0136] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.
[0137] The memory may include non-permanent storage in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.
[0138] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.
[0139] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.
[0140] Those skilled in the art will appreciate that the embodiments of this specification may be provided as methods, systems or computer program products. Therefore, this specification may take the form of a complete hardware embodiment, a complete software embodiment or an embodiment combining software and hardware. Moreover, this specification may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0141] This specification may be described in the general context of computer-executable instructions executed by a computer, such as program modules. Generally, program modules include routines, programs, objects, components, data structures, etc. that perform specific tasks or implement specific abstract data types. This specification may also be practiced in distributed computing environments where tasks are performed by remote processing devices connected through a communication network. In a distributed computing environment, program modules may be located in local and remote computer storage media including storage devices.
[0142] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the system embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.
[0143] The above description is only an embodiment of the present specification and is not intended to limit the present specification. For those skilled in the art, the present specification may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present specification shall be included in the scope of the claims of the present specification.
Claims
1. A method for controlling unmanned equipment, characterized in that: include: Determine an unmanned device to be controlled in an unmanned device formation as a first device, and unmanned devices located around the first device in the unmanned device formation as second devices; Determine, based on the acquired driving data of the first device and the driving data of the second device, an actual distance between a position of the first device at a current moment and a position of the second device at a specified historical moment, and determine an expected distance between the first device at a current moment and the second device at the specified historical moment, wherein determining the actual distance between the position of the first device at a current moment and the position of the second device at the specified historical moment specifically includes: Determine, based on the position of the first device at the current moment, the position of the second device at the specified historical moment, and a preset device length, the actual distance between the position of the front end of the first device at the current moment and the position of the rear end of the second device at the specified historical moment, wherein the determining of the expected distance between the first device at the current moment and the second device at the specified historical moment includes determining, based on the distance traveled by the first device at the current moment within a preset buffer time at a speed perceived by the first device at the current moment and a preset minimum distance between unmanned devices, a basic distance between the first device at the current moment and the second device at the specified historical moment; determining a corrected distance based on a distance traveled by the second device from the specified historical moment to the current moment at the speed perceived by the second device at the specified historical moment; Determining the expected spacing according to the basic spacing and the corrected distance; Based on the deviation between the actual spacing and the expected spacing, and the determined control amount of the second device at the specified historical moment, the control amount for the first device at the current moment is determined as the target control amount, and the first device is controlled according to the target control amount.
2. The method according to claim 1, characterized in that The driving data includes: state data and control data; the state data includes: the distance between each unmanned device in the unmanned device formation, the position data of the unmanned device, the speed of the unmanned device, and the acceleration of the unmanned device; the control data includes: the control amount of the unmanned device controlling its own driving; Acquiring the driving data of the first device and the second device specifically includes: By means of a sensor mounted on the first device, state data of the first device and the second device during driving are collected and stored; The control data sent by the second device and used for controlling the second device itself is obtained through the communication module mounted on the first device.
3. The method according to claim 2, characterized in that The time length from the specified historical moment to the current moment is not less than the maximum value of the communication delay for the second device to send control data through the communication module and the perception delay for the first device to collect data through the sensor.
4. The method according to claim 1 or 3, characterized in that Determining the control amount of the second device at the specified historical moment specifically includes: Determine the control amount of the first device at the specified historical moment, obtain a first proportional control parameter and a first differential control parameter corresponding to the first device, and obtain a second proportional control parameter and a second differential control parameter corresponding to the second device; Determine a weighted sum value obtained by weighting the control amount of the second device at the specified historical moment by the first proportional control parameter and the set order control amount of the second device at the specified historical moment by the first differential control parameter as a first sum value, and determine a weighted sum value obtained by weighting the control amount of the first device at the specified historical moment by the second proportional control parameter and the set order control amount of the first device at the specified historical moment by the second differential control parameter as a second sum value; With the first sum value matching the second sum value as a constraint, the control amount of the second device at the specified historical moment is determined by the following formula: in, It is used to indicate the control amount of the first device at the current moment. It is used to represent the control amount of the second device at the current moment, where: Used to represent the first proportional control parameter, Used to represent the first differential control parameter, Used to represent the second proportional control parameter, Used to represent the second derivative control parameter.
5. The method according to claim 1, characterized in that The method further comprises: After the target control amount is determined, the stored driving data of the second device before the specified historical moment is deleted.
6. An unmanned driving device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the program, the method according to any one of claims 1 to 5 is implemented.
