Positioning at least one vehicle in relation to a set of moving targets
11292559 · 2022-04-05
Assignee
Inventors
- John Paterson Bookless (Bristol South Gloucestershire, GB)
- Markus Deittert (Bristol South Gloucestershire, GB)
Cpc classification
B63B79/40
PERFORMING OPERATIONS; TRANSPORTING
B60W60/00272
PERFORMING OPERATIONS; TRANSPORTING
B60W2754/10
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A method and system for positioning a vehicle in relation to each moving target of an ordered set of moving targets. Each of the moving targets moves from an initial position at a constant velocity. Embodiments can compute an estimated time for the vehicle to be positioned within a predetermined proximity of one of the moving targets; compute an estimated location of the moving target at the estimated time, based on a current position of the moving target and the constant velocity of the moving target, and compute a required velocity for the vehicle to move from its current position to reach the estimated location by the estimated time. If the required velocity is less than or equal to a maximum velocity of the vehicle, outputting the estimated time and the estimated location for use in positioning the vehicle.
Claims
1. A computer-implemented method of positioning a vehicle in relation to each moving target of an ordered set of moving targets, wherein each of the moving targets moves from a respective initial position at a respective constant velocity, the method comprising: i) computing, by selecting a range-limited random value, an estimated time (t.sub.x); ii) computing, based on a current position of the moving target and the constant velocity of the moving target, an estimated location (r.sub.x) of the moving target at the estimated time (t.sub.x); iii) computing a required velocity for the vehicle to move from its current position to reach a location within a predetermined proximity of the estimated location (r.sub.x) of the moving target by the estimated time (t.sub.x); iv) if the required velocity is less than or equal to a maximum velocity of the vehicle, outputting the estimated time and the estimated location for use in positioning the vehicle; and if the required velocity is greater than the maximum velocity of the vehicle, increasing the estimated time (t.sub.x), and repeating ii)-iv).
2. The method according to claim 1, further comprising repeating i)-iv) for each subsequent moving target in the set, wherein the current position of the vehicle is taken to correspond to the estimated location of a previous moving target in the set.
3. The method according to claim 1, comprising repeating i)-iv) for a plurality of vehicles, where each of the plurality of vehicles is associated with its own ordered set of moving targets.
4. The method according to claim 3, wherein i)-iii) at least are performed by solving an optimisation problem.
5. The method according to claim 4, wherein the optimisation problem comprises determining/seeking: a first time and a first position, and a second time and a second position, which meet the following conditions the first position is within a predetermined proximity of a location of the first moving target at the first time, the second position is within the predetermined proximity of a location of a second moving target at the second time, and a distance between the first position and the second position is no greater than a distance the vehicle can travel at, or below, a maximum velocity of the vehicle for a duration equal to or less than a difference between the second time and the first time, and/or a difference between the second time and the first time is no greater than a time taken for the vehicle to travel from the first position to the second position at, or below, a maximum velocity of the vehicle.
6. The method according to claim 4, wherein the optimisation problem is represented by an expression
7. The method according to claim 6, wherein a constraint on solutions to the optimisation problem is expressed by
8. The method according to claim 4, wherein the optimization problem is solved using a processor executing a Linear Programming optimization solver.
9. A system adapted to position a vehicle in relation to a set of moving targets, the system comprising at least one processor configured to: i) compute, by selecting a range-limited random value, an estimated time (t.sub.x); ii) compute, based on a current position of the moving target and the constant velocity of the moving target, an estimated location (r.sub.x) of the moving target at the estimated time (t.sub.x); iii) compute a required velocity for the vehicle to move from its current position to reach a location within a predetermined proximity of the estimated location (r.sub.x) of the moving target by the estimated time (t.sub.x); iv) if the required velocity is less than or equal to a maximum velocity of the vehicle, output the estimated time and the estimated location for use in positioning the vehicle; and if the required velocity is greater than the maximum velocity of the vehicle, increase the estimated time (t.sub.x), and repeat ii)-iv).
10. The system according to claim 9, further including a communications interface configured to transfer signals representing the estimated time and the estimated location to at least one vehicle.
11. A vehicle including the system according to claim 9.
12. The vehicle according to claim 11, wherein the vehicle is at least partly autonomous.
13. The vehicle according to claim 11, wherein the vehicle comprises a water-borne vessel.
14. A computer program product including one or more non-transitory machine-readable mediums encoded with instructions that when executed by one or more processors cause a process to be carried out for positioning a vehicle in relation to each moving target of an ordered set of moving targets, wherein each of the moving targets moves from a respective initial position at a respective constant velocity, the process comprising: computing, by selecting a range-limited random value, an estimated time (t.sub.x); computing, based on a current position of the moving target and the constant velocity of the moving target, an estimated location (r.sub.x) of the moving target at the estimated time (t.sub.x); computing a required velocity for the vehicle to move from its current position to reach a location within a predetermined proximity of the estimated location (r.sub.x) of the moving target by the estimated time (t.sub.x); in response to the required velocity being less than or equal to a maximum velocity of the vehicle, outputting the estimated time and the estimated location for use in positioning the vehicle.
15. The computer program product of claim 14, the process further comprising: in response to the required velocity being greater than the maximum velocity of the vehicle, increasing the estimated time (t.sub.x); computing, based on a current position of the moving target and the constant velocity of the moving target, an estimated location (r.sub.x) of the moving target at the estimated time (t.sub.x); computing a required velocity for the vehicle to move from its current position to reach a location within a predetermined proximity of the estimated location (r.sub.x) of the moving target by the estimated time (t.sub.x); and in response to the required velocity being less than or equal to a maximum velocity of the vehicle, outputting the estimated time and the estimated location for use in positioning the vehicle.
16. The computer program product of claim 14, the process further comprising repeating the process for each subsequent moving target in the set, wherein the current position of the vehicle is taken to correspond to the estimated location of a previous moving target in the set.
17. The computer program product of claim 14, the process comprising repeating the process for a plurality of vehicles, where each of the plurality of vehicles is associated with its own ordered set of moving targets.
18. The computer program product of claim 17, wherein the computing comprises solving an optimisation problem.
19. The computer program product of claim 18, wherein the optimisation problem comprises determining: a first time and a first position, and a second time and a second position, which meet the following conditions the first position is within a predetermined proximity of a location of the first moving target at the first time, the second position is within the predetermined proximity of a location of a second moving target at the second time, and a distance between the first position and the second position is no greater than a distance the vehicle can travel at, or below, a maximum velocity of the vehicle for a duration equal to or less than a difference between the second time and the first time, and/or a difference between the second time and the first time is no greater than a time taken for the vehicle to travel from the first position to the second position at, or below, a maximum velocity of the vehicle.
20. The computer program product of claim 18, wherein the optimisation problem is represented by an expression
Description
BRIEF DESCRIPTION OF THE FIGURES
(1) For a better understanding of the invention, and to show how embodiments of the same may be carried into effect, reference will now be made, by way of example, to the accompanying diagrammatic drawings in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
DETAILED DESCRIPTION OF THE FIGURES
(9)
(10) Each of the vehicles 102A, 102B comprises a control system 104A, 104B that includes circuitry or the like to directly control one or more positioning components/sub-systems of the vehicle, including ones that can control the direction and speed of the vehicle, thereby allowing it to function as an at least partly autonomous vehicle. That is, the positioning of the vehicle may be directly automatically controlled by computer-generated signals, rather than by a human operator. The extent of the autonomous control can vary. For example, the direction and/or speed of the vehicle may be controlled by computer-generated signals, whilst other features or sub-systems of the vehicle may be under (local or remote) human control. Also, it may be possible to switch the vehicle between fully-autonomous, partly-autonomous and/or manual control methods.
(11) Each of the control systems 104 may generate its own control signals, or may receive them from a remote source (e.g. over a wireless communications network), such as from a mission planner system 105. In other embodiments, a control system onboard one of the vehicles may generate control signals that are transferred to others of the control systems, or two or more of the control systems may cooperate in order to generate control signals for the vehicles.
(12)
(13) In the example of
(14)
(15) The computing device 200 typically includes a processor 202 and a memory 204. The computing device can further include at least one communications interface 206 that allows it to transfer data to/from other devices, such as computing devices/control systems 104 installed onboard one or more of the (other) vehicles 102. The communications interface will typically provide wireless communication over a communications network and may transfer data in an encrypted manner. The computing device may comprise further conventional components, such as a display, user interface, external storage, etc, that need not be described here in detail. In some cases the components and/or functions of the computing device may be distributed.
(16) The memory 204 is shown as schematically comprising/communicating with software components that form at least part of a planner system. In some embodiments the planner system is a mission planning and optimisation tool that aims to extend a Combat Management System's (CMS) functionality to enable the CMS to command and control unmanned off-board systems. Embodiments of the planner system can formulate mission plans for off-board systems by decomposing the mission objectives, as stated by the operator, into tasks that are assigned to the available assets and the execution times of which are scheduled.
(17) In some embodiments three components of the planner system can interact in order to determine the task assignments and the task execution schedule: a task assignment algorithm 208; a scheduler 210, and a cost function 212. The task assignment algorithm 208 can provide a (full or partial) assignment of tasks (e.g. moving within a predetermined proximity of a set of moving targets) to actors (e.g. the at least partially autonomous vehicles 102). The scheduler 210 can compute the (optimal in some cases) task execution schedule for a given (full/partial) assignment. The cost function 212 can attribute a scalar cost value to the proposed assignment and schedule. All or some of these components may be implemented using GNU Linear Programming Kit available at https://www.gnu.org/software/glpk/, for example. The task assignment algorithm can propose a new assignment and subsequently build or select the final assignment based on the received cost values. It will be understood that the task assignment algorithm 208 and the cost function 212 are optional, and embodiments may comprise the scheduler 210, which can operate independently of other components in some cases.
(18)
(19) It will also be appreciated that the illustrated steps of the flowcharts herein are exemplary only and in alternative embodiments some of them may be omitted, re-ordered and/or performed concurrently rather than sequentially. Further, additional steps (not illustrated) may be performed. The skilled person will understand that the steps can be implemented by hardware and/or software, using any suitable programming languages/techniques and data structures, where appropriate. The method may be started and/or terminated by a user, or automatically when certain conditions are met, e.g. based on external control signals being received.
(20) At step 302 embodiments can write a problem model file. This file can contain data such as the initial position(s) (and in some cases velocity) of each of a set of one or more vehicles 102; the maximum velocity of each of the set of one or more vehicles; the initial position(s) of each of a set of one or more moving target(s) 106; the initial/constant velocity of each of the set of one or more moving target(s). This file can be created by a programmer and can provide an implementation of the optimisation problem. It will be understood that in alternative embodiments this information can be represented/processed using any suitable data structure(s).
(21) At step 304 embodiments can write a problem data file. This file can contain data such as an ordered set/list of (one or more of) the moving targets 106A-106C to be targeted by one or more of the vehicles 102A, 102B. This file can contain the problem-specific coefficients and may be created automatically by a suitable piece of software, or manually by a programmer. The order may be determined in any suitable manner, e.g. the initial position of a moving target with respect to a particular location, user-assigned based on priority, etc. It will be understood that in alternative embodiments this information can be represented/processed using any suitable data structure(s).
(22) At step 306 embodiments can use the files written at steps 302 and 304 to generate a schedule, e.g. by solving an optimization problem. The output of this step can comprise a solution data file (or other data structure) that comprises for each of the vehicles an ordered set/list of time/location pairs (as detailed below) representing a best solution/attempt at having each of the vehicles fulfil its tasks.
(23) At step 308 embodiments can parse the solution data file, e.g. convert to signals that can be used as control signals for the vehicles 102. This parsing can be performed by general purpose solvers, such as GLPK, and can further comprise checking at step 310 whether the time/location pairs fulfil all the tasks assigned to the vehicles. For instance, in some cases the tasks (interception of the moving targets in their listed order) may not be achievable by a vehicle, e.g. due to an in sufficient maximum velocity.
(24) If the check of step 310 indicates that tasks are fulfilled then control passes to step 312, where data from the solution data file may be used to position the vehicle(s). This can involve sending signals to the control system(s) 104 of the vehicle(s) 102 in order to directly control the positions of the vehicle(s) based on the computation results. Additionally or alternatively, this can include displaying information to assist a (local or remote) operator with controlling the positions of one or more of the vehicles and/or for simulation purposes. Such operations may be done substantially in real-time as the method is executed, or data based on the computation results may be stored for future use. In some cases, embodiments of the method may be performed in order to plan before a mission, e.g. repeat its calculations for future nominal time steps. In other cases, embodiments of the method may be performed initially in order to plan while the mission is being executed, then after a period of time/waiting its calculations are repeated so that the positions for the vehicles are recomputed based on up-to-date information.
(25) If the time/location pairs do not fulfil all (or some of) the tasks then control may pass to step 314, where a suitable action is taken, e.g. generating an exception message so that a user can take appropriate alternative action (e.g. replace one or more of the vehicles with ones having a higher maximum velocity).
(26)
(27) At step 402 embodiments can select a first one of the vehicles in the set, typically the first one listed in an ordered list that comprises the set of vehicles. However, in some embodiments this may vary, e.g. based on an updated priority value assigned to a particular vehicle.
(28) At step 404 embodiments can select a first task, e.g. moving the selected vehicle to a location that is within the predetermined proximity of the first moving target listed in the ordered list that comprises the set of moving targets.
(29) At step 406 embodiments can compute at least an estimated time when the selected vehicle should move to a location that is within the predetermined proximity of the selected task's moving target. In some cases, this estimated time may comprise the earliest possible time when the vehicle can move to that location. Examples of the computations that can achieve this are described below.
(30) At step 408 embodiments can check whether the selected vehicle has further tasks to perform. It is has then control passes back to step 404, where the next task (e.g. moving to a location that is within the predetermined proximity of a second moving target listed in the ordered list) is selected. If the check performed at step 408 indicates that the selected vehicle has no further tasks to perform then control passes to step 410.
(31) At step 410 embodiments can check whether there are further vehicles in the set of vehicles. If there is then then control can pass back to step 402, where the next vehicle (e.g. the second vehicle listed in the ordered list of vehicles) is selected. If there are no further vehicles then control can pass to step 412.
(32) At step 412 embodiments can output data relating to the estimated times and locations computed at step 406 for storage and/or processing.
(33) As illustrated in
(34)
(35) At step 602 embodiments can estimate an initial positive time, t.sub.x, for the task's execution. That is, embodiments can compute an initial estimated time for the selected vehicle to be positioned within a predetermined proximity of the selected moving target. This can be done initially by selecting a range-limited random value or a default value, for example.
(36) At step 604 embodiments can compute the estimated location of the task's target at the estimated time, r.sub.x=f(t.sub.x). That is, embodiments can compute an estimated location of the selected target at the estimated time, based on the current position and the constant velocity of the moving target.
(37) At step 606 for a given pair of the estimated time and the estimated location, embodiments can compute the velocity required to move the selected vehicle from its current position to the estimated location in order to arrive at the estimated time. If the required speed is greater than the vehicle's maximum speed then the task's execution time needs to be increased by a small amount (one or more). In other embodiments, the time value may be incremented/decremented by certain steps, or adjusted in some other manner. If the required speed equals the vehicle's maximum speed then it can be considered that the optimal value has been found. At least the estimated time and the estimated location may be output for further processing.
(38) As indicated in
(39) In an example where there is a set comprising two vehicles 102A, 102B, with three tasks each relating to sets of moving targets 106A-106C and 106D-106F (e.g. first vehicle 102A has [Task_0, Task_1, Task_2] and second vehicle 1026 has [Task_3, Task_4, Task_5]) the operations can be as follows:
(40) For the first vehicle 102A and Task_0, no previous location exists and so t.sub.0=0 and r.sub.0=r.sub.0(0).
(41) For the first vehicle 102A and Task_1, a value is picked for t.sub.1, r.sub.1=r.sub.1(0)+v.sub.1*t.sub.1 is computed as a result and the travel speed is given by: v.sub.0,1=(r.sub.1−r.sub.0)/(t.sub.1−t.sub.0).
(42) For the first vehicle 102A and Task_2, a value is picked for t.sub.2, r.sub.2=r.sub.2(0)+v.sub.2*t.sub.2 is computed as a result and the travel speed is given by: v.sub.1,2=(r.sub.2−r.sub.1)/(t.sub.2−t.sub.1)
(43) And so on.
(44) Some embodiments of the scheduler can use a Linear Programming approach to generate the schedule by solving an optimization problem (e.g. using a processor executing an optimization solver, such as GLPK). Such embodiments can use the following optimization variables, for example:
(45) TABLE-US-00002 t Task execution time, i.e. t(i) = x denotes that the executing asset arrives at the i.sup.th task x seconds after mission start. p Task positions, i.e. p(i) = [x, y] denotes that the i.sup.th task is located at position [x, y] at time t.sub.i = x (execution time) t.sub.end Mission completion time for each asset, i.e. t.sub.end(i) = x denotes that the i.sup.th asset completes it's last task at time x. t.sub.start Mission start time for each asset, i.e. t.sub.end(i) = x denotes that the i.sup.th asset starts it's first task at time x. Dp Inter-task distance matrix, dp(i, j) = [dx, dy] denotes that the distance vector [dx, dy] between the i.sup.th and j.sup.th tasks at their respective execution times. Dt time difference between tasks, dt(i, j) = x denotes that the execution times of task i and task j differ by an amount of x, i.e. t(j) − t(i) = x
(46) These variables can be used for solving an optimisation problem that can be expressed using the following expression:
(47)
(48) Constraints of the optimisation problem can include: link task execution times to the execution order in the assignment matrix; link task position to execution time; inter-task distances (substitution); temporal difference (substitution); temporal and spatial separation between tasks based on schedule; time vector magnitudes, and/or task positions.
(49) The task execution order may be represented using the following terms: Let x be a constant matrix of task assignments, with x[a,i,j]=1 indicating that the a.sup.th vehicle executes task j after executing task i. Let n.sub.t be the total number of tasks and let n.sub.v be the total number of vehicles
(50) The constraint is thus expressed as
(51)
(52) The constraint above can ensure that the execution time of two tasks, which are executed by the same vehicle and in the order of i before j, have the correct relation, i.e. t(i) is less than or equal to t(j).
(53) The positions of the targets of the tasks can be represented using the following terms: Let p.sub.0 be a constant matrix of task positions at t=0 and let v be a matrix of velocities. Let n.sub.t be the total number of tasks
∀i∈[1 . . . n.sub.t]
p(i,1)=p.sub.0(i,1)+v(i,1).Math.t
p(i,2)=p.sub.0(i,2)+v(i,2).Math.t
(54) The constraint above can ensure that the position of each task is correctly related to the task's execution time. The position is computed as the linear extrapolation from the task's position a t=0 with the velocity, v, of the target of the task.
(55) The spatial and temporal separation of the tasks can be reflected by the list of variables, where dp represents the difference vector of task location and dt represents the difference of execution time. In embodiments it can be assumed that the time difference is fixed, i.e. two tasks that are executed sequentially by the same vehicle/actor are separated in time by x seconds. Based on the maximum speed, v.sub.max, of a vehicle the distance between the tasks must be less than v.sub.maxdt. Hence, the magnitude of the vector dp is limited by v.sub.maxdt.
(56)
(57)
(58) The equation above represents a key constraint that can be used by embodiments of the scheduler.
(59) The skilled person will appreciate that alternative embodiments can be produced in order to deal with variations, such as tasks with a non-zero duration; temporal constraints on tasks; tracks that do not move in a straight line, e.g. piecewise straight lines, and/or tracks that have a future position probability (tasks are scheduled and positioned, such that the likelihood of intercepting the target is maximised).
(60) Embodiments can provide advantages, including allowing implementation on vehicles with limited autonomy and capability, e.g. waypoint following only, thereby enabling users to acquire such vehicles from a greater range of suppliers.
(61) Attention is directed to any papers and documents which are filed concurrently with or previous to this specification in connection with this application and which are open to public inspection with this specification, and the contents of all such papers and documents are incorporated herein by reference.
(62) All of the features disclosed in this specification (including any accompanying claims, abstract and drawings), and/or all of the steps of any method or process so disclosed, may be combined in any combination, except combinations where at least some of such features and/or steps are mutually exclusive.
(63) Each feature disclosed in this specification (including any accompanying claims, abstract and drawings) may be replaced by alternative features serving the same, equivalent or similar purpose, unless expressly stated otherwise. Thus, unless expressly stated otherwise, each feature disclosed is one example only of a generic series of equivalent or similar features.
(64) The invention is not restricted to the details of the foregoing embodiment(s). The invention extends to any novel one, or any novel combination, of the features disclosed in this specification (including any accompanying claims, abstract and drawings), or to any novel one, or any novel combination, of the steps of any method or process so disclosed.