A METHOD OF CONTROLLING A PLURALITY OF VEHICLES PERFORMING THE SAME MISSION CYCLE
20220171407 · 2022-06-02
Assignee
Inventors
Cpc classification
G05D1/0214
PHYSICS
International classification
G06Q10/06
PHYSICS
Abstract
The invention relates to a method of controlling a plurality of vehicles, performing the same mission cycle, comprising mapping a first set of planned degrees of progress (CCP1) to the cycle, controlling the vehicles to start the cycle at respective different points in time, determining deviations of the vehicles from a respective planned degree of progress (CCP1i) of the first set of planned degrees of progress (CCP1), mapping, based on the determined deviations, a second set of planned degrees of progress (CCP2) to the cycle, and controlling the vehicles so as to minimize deviations of the vehicles from a respective planned degree of progress (CCP2i) of the second set of planned degrees of progress (CCP2).
Claims
1. A method of controlling a plurality of vehicles, performing the same mission cycle, the method being characterized by mapping a first set of planned degrees of progress to the cycle, controlling the vehicles to start the cycle at respective different points in time, determining deviations of the vehicles from a respective planned degree of progress of the first set of planned degrees of progress, mapping, based on the determined deviations, a second set of planned degrees of progress to the cycle, and controlling the vehicles so as to minimize deviations of the vehicles from a respective planned degree of progress (CCP2i) of the second set of planned degrees of progress.
2. A method according to claim 1, characterized in that the step of controlling the vehicles so as to minimize deviations, of the vehicles from a respective planned degree of progress of the second set of planned degrees of progress, is done on the condition that the second set of planned degrees of progress represent a faster progress than the first set of planned degrees of progress.
3. A method according to claim 1, characterized by dividing the cycle into stages with respective vehicle activities, wherein mapping the first set of planned degrees of progress to the cycle comprises mapping the first set of planned degrees of progress to the cycle stages.
4. A method according to claim 3, characterized in that determining deviations of the vehicles, from a respective planned degree of progress, comprises determining the stages in which the vehicles are in.
5. A method according to claim 1, characterized in that mapping the first set of planned degrees of progress to the cycle comprises mapping the first set of planned degrees of progress to the time from the start of the cycle by the respective vehicle.
6. A method according to claim 1, characterized in that mapping a first set of planned degrees of progress to the cycle comprises mapping a plurality of first values, of a progress degree parameter, to the cycle.
7. A method according to claim 6, characterized in that determining deviations of the vehicles from the respective planned degree of progress comprises, for each vehicle, comparing an actual value of the progress degree parameter to a respective first progress degree parameter value.
8. A method according to claim 6, characterized in that determining deviations of the vehicles from the first planned degree of progress comprises, for each vehicle, calculating a progress degree difference as a difference between the actual progress degree parameter value and the respective first progress degree parameter value.
9. A method according to claim 8, characterized by determining an advancement indicator based on the progress degree difference for the respective vehicle.
10. A method according to claim 9, characterized in that mapping, based on the determined deviations, a second set of planned degrees of progress to the cycle, comprises calculating an average value of the advancement indicators of the vehicles.
11. A method according to claim 6, characterized in that mapping, based on the determined deviations, a second set of planned degrees of progress to the cycle, further comprises mapping a plurality of second progress degree parameter values, to the cycle.
12. A method according to claim 11, characterized in that the second progress degree parameter values differ from the first progress degree parameter values, by a constant value.
13. A method according to claim 10, characterized in that said constant value is equal to the average advancement indicator value.
14. A method according to claim 11, characterized in that the time derivate, of the second progress degree parameter values, differs from the time derivate, of the first progress degree parameter values.
15. A method according to claim 10, characterized in that said time derivate difference is equal to the average advancement indicator value.
16. A method according to claim 10, characterized in that the step of controlling the vehicles so as to minimize deviations, of the vehicles from a respective planned degree of progress of the second set of planned degrees of progress, is done on the condition that the average advancement indicator value indicates an average progress of the vehicles that is faster than the first set of planned degrees of progress.
17. A computer program comprising program code means for performing the steps of claim 1 when said program is run on a computer, or a group of computers.
18. A computer readable medium carrying a computer program comprising program code means for performing the steps of claim 1 when said program product is run on a computer, or a group of computers.
19. A control unit, or a group of control units, configured to perform the steps of the method according to claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0034] With reference to the appended drawings, below follows a more detailed description of embodiments of the invention cited as examples.
[0035] In the drawings:
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
DETAILED DESCRIPTION OF EXAMPLE EMBODIMENTS OF THE INVENTION
[0043]
[0044] In this example, the vehicles perform the same mission cycle in a mine. However, the invention is applicable to a variety of vehicle missions. Further, the vehicles may be of any type suitable for the particular mission. For example, the vehicles may be road trucks, delivery vans, buses, or cars.
[0045] The mission involves driving on a route, from a start position A to an end position C, via an intermediate positon B. The environment is in this example a mine, but the route could be in any type of environment, such as in a construction site, along an urban road, and/or along a rural road. In this example, the mission involes loading at position A, passing a gate at position B, and unloading at position C. In general, the route could include any number of positions for respective specified activities. The activities could be of any suitable alternative type, for example delivery or pick-up of goods or people, or fuelling and/or charging of batteries of the vehicles.
[0046] In this example, the vehicles V1-V3 return to position A after having completed the activity at position C. Thus, the mission could be referred to as a circulating mission. In alternative embodiments, the mission could, as opposed to be circulating, extend from a start position and terminate at an end position at a location which is different from that of the start position.
[0047] A control unit CU is arranged to carry out steps of an embodiment of a method according to the invention. The control unit could be a part of a control center for controlling the vehicles V1-V3. The control unit CU is arranged to communicate wirelessly with each of the vehicles V1-V3.
[0048] The control unit CU may be arranged to receive information from the vehicles, e.g. regarding their positions, and speeds. The control unit may also be arranged to send control commands to the vehicles. In some embodiments, the vehicles are driverless, and control devices (not shown) in the vehicles, which are arranged to control operational devices of the vehicles, such as engines, motors, brakes and steering, may be arranged to read the control commands from the control unit CU. In other embodiments, the vehicles may be arranged to display control commands from the control unit CU, to drivers of the vehicles.
[0049] In some embodiments, the control unit CU could be located on one of the vehicles, or parts of the control unit CU could be distribued on a plurality of the vehicles.
[0050] It is understood that the control unit CU comprise a computer. It is further understood that the control unit CU may be arranged to carry out an embodiment of the method according to the invention, by means of a computer program.
[0051] With reference to
[0052] Reference is made also to
[0053] The method further comprises mapping S2, for each vehicle V1-V3, a first planned degree of progress to the cycle stages. The first planned degrees of progress of the vehicles are herein collectively referred to as a first set of planned degrees of progress. In this example, the first planned degrees of progress are the same for all vehicles. Mapping the first set of planned degrees of progress to the cycle comprises in this example mapping first values, of a progress degree parameter CCP, to the cycle. The progress degree parameter CCP is indicated along the horizontal axis in
[0054] Reference is also made to
[0055] For example, loading at position A may be estimated to take 2:42 minutes. Estimating the duration for moving from position A to position B may involve estimating a speed profile of the respective vehicle along that part of the route. Based on the speed profile, the duration can be determined. Waiting at the gate at position B may be estimated to take 20 seconds. The duration for moving from position B to position C may be determined based on an estimated speed profile, in the manner suggested for moving from position A to position B. Unloading at position C may be estimated to take 2:53 minutes.
[0056] Thereafter, the total estimated duration for the cycle may be linearly adapted to the progress degree parameter so that the time from start to completion of the cycle matches values of the progress degree parameter from 0 to 100%.
[0057] The method involves controlling S3 the vehicles to start the cycle at respective different points in time. Preferably, there is a constant time interval between all pairs of subsequent starts. the vehicles are started
[0058] When all vehicles have started, deviations of the vehicles, from the respective first planned degree of progress, are determined S4. Such a determination may be made at a predetermined time interval after the last vehicle start. Thereby, the status of each vehicle is determined.
[0059] Determining the status of a vehicle may involve determining the stage in which the vehicle is in. The status determination may further involve determining the degree of completion of the stage in which the vehicle is in. Such a degree of completion could be e.g. a loading percentage completed, a distance traveled etc. The stages, and the degrees of completion of the stages, that the vehicles are in, may be identified by suitable devices, such as GPS (Global Positioning System) devices, sensors, and cameras. Such devices may be placed in the vehicles, and/or along the route. Information from the devices may be communicated to the control unit CU.
[0060] Based on the status of the respective vehicle, an actual value of the progress degree parameter CCP is determined. This may be done using the diagram in
[0061] Further, the planned degree of progress CCP is determined. This may be done based on the time which has elapsed since the start of the respective vehicle. This may be also be done using the diagram in
[0062] Reference is made also to
[0063] An advancement indicator is determined to be the progress degree difference ΔCCPi. In some embodiments, the advancement indicator is calculated as a ratio λ.sub.i between the progress degree difference ΔCCPi and the respective time ti since start for the respective vehicle. It should be noted that in this example, if the respective vehicle is ahead of the planned degree of progress CCP1i, the progress degree difference ΔCCPi, and hence the advancement indicator λ.sub.i, is positive. If the respective vehicle is behind the planned degree of progress CCP1i, the progress degree difference ΔCCPi, and hence the advancement indicator Δ.sub.i, is negative.
[0064] Reference is made also to
[0065] An average value
[0066] For .sub.ith vehicle, a relative advancement indicator, denoted by σ.sub.i, with respect to the vehicle fleet, may be determined as:
σ.sub.i−λ.sub.i−
[0067] Further steps of the method are dependent on whether a second set of planned degrees of progress represent a faster progress than the first set of planned degrees of progress. As explained below said second set is determined based on the average advancement indicator value
[0068] If the average advancement indicator value
[0069] However, if the average advancement indicator value
[0070] Reference is made again to
[0071] Reference is made to
[0072] It is to be understood that the present invention is not limited to the embodiments described above and illustrated in the drawings; rather, the skilled person will recognize that many changes and modifications may be made within the scope of the appended claims.