DEVICE AND METHOD FOR AUTONOMOUS MANAGEMENT OF A DRONE

Abstract

An intelligent device for autonomous navigation of a drone comprising a control unit arranged to communicate with a remote-control station by a wireless connection, acquire a mission route ? that the drone is arranged to follow to reach a desired destination, the mission route ? being defined by means of coordinates x.sub.m(t), y.sub.m(t), z.sub.m(t) with respect to a reference system S(x,y,z), periodically acquire values x.sub.d, y.sub.d, z.sub.d corresponding to the components of the spatial position, values v.sub.x, v.sub.y, v.sub.z corresponding to the components of the speed and values a.sub.x, a.sub.y, a.sub.z corresponding to the components of the acceleration. Furthermore, in the event that a predetermined kinematic condition occurs, the control unit is arranged to check the status of the wireless connection with the remote-control station and, in the event that the wireless connection is active, send an alarm signal to the remote-control station and wait a response time t.sub.r.

Claims

1. An intelligent device for autonomous navigation of a drone, said drone comprising at least one motor suitable for allowing the in-flight movement of said drone, said intelligent device comprising a control unit arranged, in use, to be connected to said or each motor in order to control the navigation of said drone, said control unit being also arranged to: communicate with a remote-control station by a wireless connection; acquire a mission route ? that said drone is arranged to follow to reach a desired destination, said mission route ? being defined by means of coordinates x.sub.m(t), y.sub.m(t), z.sub.m(t) with respect to a reference system S(x, y,z); periodically acquire values x.sub.d, z.sub.d corresponding to the components of the spatial position of said drone with respect to said reference system S(x,y,z); periodically acquire values v.sub.x, v.sub.y, v.sub.z corresponding to the components of the speed of said drone with respect to said reference system S(x,y,z); periodically acquire values a.sub.x, a.sub.y, a.sub.z corresponding to the components of the acceleration of said drone with respect to said reference system S(x, y,z); said intelligent device characterized in that said control unit is also arranged to: check the status of said wireless connection with said remote-control station, in the event that at least one of the following conditions occurs: at time t*, x.sub.d>x.sub.m(t*)+d.sub.x and/or y.sub.d>y.sub.m(t*)+d.sub.y and/or z.sub.d>z.sub.m(t*)+d.sub.z; v.sub.x>v.sub.x and/or v.sub.y>v*.sub.y and/or v.sub.z>v*.sub.z; a.sub.x>a*.sub.x and/or a.sub.y>a*.sub.y and/or a.sub.z>a*.sub.z; where d.sub.x, d.sub.y, d.sub.z, V*.sub.x, v*.sub.y, v*.sub.z, a*.sub.x, a*.sub.y, a*.sub.z are predetermined values; in the event that said wireless connection is active, send an alarm signal to said remote-control station and wait a response time t.sub.r; in the event that said wireless connection is not active or in the event that there is no response from said remote-control station within said response time t.sub.r, activate an emergency navigation mode wherein said control unit is arranged to: acquire a value E.sub.res corresponding to the energy available on board of said drone; calculate a value E.sub.mis corresponding to the energy required by said drone to reach said desired destination following said mission route ?; in the event that E.sub.res?k.sub.mis*E.sub.mis, where k.sub.mis is a coefficient greater than or equal to 1, control the navigation of said drone along said mission route ?; in the event that E.sub.res<k*E.sub.mis, control the navigation of said drone along a route alternative to said mission route ? to bring said drone to perform a safe landing.

2. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein to calculate said value E.sub.mis, said control unit is arranged to carry out an estimate of the speed of the wind acting along said mission route ?.

3. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein, in the event that E.sub.res<k*E.sub.mis, said control unit is arranged to: carry out an estimate of the speed of the wind acting along a plurality of routes ?.sub.i alternative to said mission route ? and able to allow said drone to reach said desired destination; calculate, for each route ?.sub.i, a value E.sub.mis.sup.i corresponding to the energy required by said drone to reach said desired destination following said route ?.sub.i; identify the lower value E.sub.mis between said energy values E.sub.mis.sup.i, said lower value E.sub.mis being associated with a route ?*; in the event that E.sub.res?k.sub.mis*E.sub.mis, control the navigation of said drone along said route ?* up to said desired destination.

4. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein, in the event that E.sub.res<k.sub.mis*E.sub.mis, said control unit is arranged to: calculate a value E.sub.cp corresponding to the energy required by said drone to reach at least one checkpoint near said mission route ?; in the event that E.sub.res>k.sub.cp*E.sub.cp, where k.sub.cp is a coefficient greater than or equal to 1, control the navigation of said drone along an alternative mission route {tilde over (?)} to bring said drone to land at said checkpoint.

5. The intelligent device for autonomous navigation of a drone, according to claim 4, wherein, in the event that E.sub.res<k.sub.cp*E.sub.cp, said control unit is arranged to control the navigation of said drone to perform an emergency landing.

6. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein said response time t.sub.r is calculated by said control unit based on the response speed of said wireless connection.

7. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein in said emergency navigation mode said control unit is arranged to check the status of said wireless connection for a time t.sub.s with a search frequency f.sub.1 and wherein, after said time t.sub.s, said control unit is arranged to check the status of said wireless connection with a search frequency f.sub.2<f.sub.1.

8. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein said intelligent device comprises furthermore: a locating means arranged to measure the components x.sub.d, y.sub.d, z.sub.d of the spatial position of said drone with respect to said reference system S(x,y,z); a speed measuring means arranged to measure the components v.sub.x, v.sub.y, v.sub.z of the speed of said drone with respect to said reference system S(x,y,z); an acceleration measuring means arranged to measure the components a.sub.x, a.sub.y, a.sub.z of the acceleration of said drone with respect to said reference system S(x,y,z).

9. The intelligent device for autonomous navigation of a drone, according to claim 1, wherein said intelligent device also comprises an antenna arranged to provide said wireless connection between said intelligent device and said remote-control station.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0060] The invention will be now shown with the following description of some exemplary embodiments, exemplifying but not limitative, with reference to the attached drawings in which:

[0061] FIG. 1 shows a preferred solution of the flow chart followed by the control unit of the intelligent device for autonomous navigation according to the present invention.

DESCRIPTION OF SOME PREFERRED EXEMPLARY EMBODIMENTS

[0062] The intelligent device for autonomous navigation of a drone, according to the present invention, comprises a control unit arranged, in use, to be connected to the motors of the drone in order to control the navigation of the drone itself.

[0063] In particular, the intelligent device can be a device external to the drone and be arranged integrally with it by connecting the control unit of the intelligent device with the on-board computer of the drone. In doing so, the intelligent device can be used on existing drones.

[0064] Alternatively, the intelligent device can be directly integrated into the drone and the control unit can be the only on-board computer of the drone.

[0065] In particular, the control unit is arranged, preferably before starting the mission, to acquire the mission route ? that the drone must follow to reach a desired destination. Such mission route ? is defined by means of coordinates x.sub.m(t), y.sub.m(t), z.sub.m(t) with respect to the reference system S(x,y,z).

[0066] Furthermore, the control unit is arranged to communicate with a remote-control station by a wireless connection. In particular, the intelligent device can comprise an antenna arranged to provide this wireless connection. Alternatively, the intelligent device can be configured for connecting the control unit to a wireless antenna placed on the drone.

[0067] Advantageously, the control unit is also suitable for connecting to an internet network.

[0068] The flow-sheet of FIG. 1 shows the following steps of a possible algorithm followed by the control unit for the intelligent device for autonomous navigation of a drone, according to the present invention.

[0069] Once the drone flight mission has started, the control unit of the intelligent device is arranged to periodically acquire the values x.sub.d, y.sub.d, z.sub.d, v.sub.x, v.sub.y, v.sub.z, a.sub.x, a.sub.y, a.sub.z corresponding to the components, respectively, of position, speed and acceleration of the drone with respect to a reference system S(x, y,z).

[0070] In particular, such components of position, speed and acceleration of the drone can be determined by respective locating means and speed and acceleration sensors present in the device. Alternatively, the control unit of the intelligent device can connect to locating means and speed and acceleration sensors on the drone.

[0071] In this way, the control unit periodically checks the position, speed and acceleration of the drone, to detect the possible presence of an anomaly during the flight.

[0072] In particular the anomaly is detected in the event that at least one of the following conditions occurs: [0073] at time t*, x.sub.d>X.sub.m(t*)+d.sub.x and/or y.sub.d>y.sub.m(t*)+d.sub.y and/or z.sub.d>z.sub.m(t*)+d.sub.z; [0074] v.sub.x>v*.sub.x and/or v.sub.y>v*.sub.y and/or v.sub.z>v*.sub.z; [0075] a.sub.x>a*.sub.x and/or a.sub.y>a*.sub.y and/or a.sub.z>a*.sub.z [0076] where d.sub.x, d.sub.y, d.sub.z, V*.sub.x, v*.sub.y, v*.sub.z, a*.sub.x, a*.sub.y, a*.sub.z are predetermined values.

[0077] The occurrence of the first condition means that the drone has moved excessively from the mission route ? along at least one of the spatial coordinates which, at the time t*, should be x.sub.m(t*), y.sub.m(t*), z.sub.m(t*).

[0078] The occurrence of at least one of the second and third conditions means that the speeds or accelerations of the drone are significantly different from the expected values.

[0079] By periodically checking the conditions on the kinematic components described above, it is possible to intervene promptly in the event that the drone loses speed or is moved by the wind or suffers a sudden change in altitude, for example due to impact with an obstacle.

[0080] If at least one of the conditions described is verified, the control unit proceeds with the verification of the wireless connection status with the remote-control station. If the connection is active, the control unit sends an alarm signal and waits for a response from the remote-control station for a time t.sub.r.

[0081] In particular, the response time ty can be a predetermined time, for example t.sub.r=3s, or can be a time calculated dynamically by the control unit based on the response speed of the wireless connection.

[0082] Advantageously, t.sub.r can be calculated using pings between the intelligent device and the remote-control station according to the equation:

t.sub.r=tp+?*?.sub.p

[0083] where tp is the mean of the ping round-trip times of the wireless connection, B is a continuous probability distribution value and op is the standard deviation of the ping round-trip times.

[0084] In the event that the control station responds within the time t.sub.r, navigation is left in manual mode and is managed remotely by the control station.

[0085] In the event, however, that the wireless connection is not active or that the control station does not respond within the time t.sub.r, the control unit enters the emergency navigation mode and begins to control the navigation of the drone.

[0086] In this way, the intelligent device according to the present invention can act promptly and autonomously both in the event of an unexpected flight or adverse weather conditions, and in the event of loss of the wireless connection, and in the event of both conditions.

[0087] In particular, according to a preferred embodiment of the invention, once it enters the emergency navigation mode, the control unit checks the value E.sub.res corresponding to the energy available on board of the drone.

[0088] In particular, the available energy is electricity that can be stored in one or more batteries. In addition, the electricity can come from solar panels or other energy sources that allow the batteries to be recharged. Alternatively, in the event that the drone is moved by non-electric motors, the available energy is measured on the basis of the energy resource used. For example, in the event that the drone uses heat engines, the available energy is measured on the basis of the fuel present on board. In the case of hybrid drones, the energy is measured on the basis of all the energy sources present on board.

[0089] The control unit then proceeds to calculate the value E.sub.mis corresponding to the energy required by the drone to reach the desired destination following the mission route ?.

[0090] In particular, to calculate the value E.sub.mis, the control unit is arranged to perform both a calculation of the nominal consumption of the motors for carrying out the mission route ? both an estimate of the speed of the wind acting along this mission route ?. In this way, the control unit can have a more accurate estimate of the real energy that will be spent to maintain the flight path by counterbalancing the action of the wind.

[0091] For example, the speed of the wind can be estimated on the basis of at least one of the following sources: [0092] wind map made on a statistical basis; [0093] weather forecasts on the internet; [0094] data provided by meteorological stations located near the mission route ?; [0095] data provided before the start of the mission.

[0096] The control unit can also draw on other sources or make an estimate based on the wind speed acting on the drone. In particular, the speed acting on the drone can be measured using sensors, for example anemometers, or it can be calculated through the difference in energy consumption that the motors produce to keep the drone along a certain trajectory.

[0097] In the event that the condition E.sub.res? k.sub.mis*E.sub.mis occurs, it means can be completed correctly and therefore controls the navigation of the drone along the mission route ? up to reaching the desired destination.

[0098] The coefficient k.sub.mis is a coefficient greater than or equal to 1 that allows you to manage the safety margin on the control unit estimate. This coefficient can be predetermined or determined in real time by the control unit. For example, the coefficient k.sub.mis can be determined by the control unit based on the accuracy of the source from which the wind conditions along the route to be travelled are derived. If the source is considered very reliable, for example a real-time forecast of weather stations located very close to the mission route y, the coefficient k.sub.mis may have a lower value than in the situation where the source is considered unreliable, such as for example a statistical wind map.

[0099] If, on the other hand, the condition E.sub.res<k.sub.mis*E.sub.mis occurs, the control unit can check the position of at least one checkpoint near the mission route ?. The positions of these checkpoints can be acquired by the control unit before the mission or even during the mission.

[0100] The control unit then proceeds to calculate a value E.sub.cp corresponding to the energy required by the drone to reach the closest checkpoint among those available.

[0101] In the event that the condition E.sub.res? k.sub.cp*E.sub.cp occurs, the control unit controls the navigation of the drone along an alternative mission route ? to bring the drone to land at the checkpoint. For the coefficient k.sub.cp the same considerations made for the coefficient k.sub.mis apply.

[0102] If, on the other hand, the condition E.sub.res<k.sub.cp*E.sub.cp occurs, the control unit is arranged to control the navigation of the drone to perform an emergency landing.

[0103] According to an embodiment of the invention, when the condition E.sub.res<k.sub.mis*E.sub.mis occurs, before verifying the position of a checkpoint, the control unit can check whether an alternative route to the mission route is available which involves a lower energy consumption.

[0104] In this situation the control unit is arranged to: [0105] carry out an estimate of the speed of the wind acting along a plurality of routes ?.sub.i alternative to the mission route ? and able to allow the drone to reach said desired destination; [0106] calculate, for each route ?.sub.i, a value E.sub.mis corresponding to the energy required by the drone to reach the desired destination following the route ?.sub.i [0107] identify the lower value E.sub.mis between the energy values E.sub.mis associating it to a route ?*; [0108] in the event that E.sub.res? k.sub.mis*E.sub.mis, control the navigation of the drone along the route ?* up to the desired destination; [0109] in the event that E.sub.res<k.sub.mis*E.sub.mis, proceed with the attempt of landing near a checkpoint.

[0110] Also in this case, the control unit can estimate the wind speed by drawing on the sources listed above.

[0111] The control unit can be set to carry out or not carry out in a predetermined way the step of computing the energy values E.sub.mis.sup.i associated with the routes ?.sub.i. Alternatively, the implementation of this step can be decided by the control unit on the basis of the available data. For example, the control unit may decide to carry out this step in the event that a source deemed sufficiently reliable is available for estimating the wind speed.

[0112] Advantageously, in the event that a refrigerant device is present on board the drone for maintaining the temperature of the transported load, the calculation of the values of E.sub.mis, E.sub.mis.sup.i and E.sub.cp comprises the step of evaluation of the consumption of such refrigerant device for maintaining the temperature.

[0113] In particular, during the emergency navigation mode, the control unit is arranged to check the status of the wireless connection for a time t.sub.s with a search frequency f.sub.1 and, after the time t.sub.s, is arranged to check the status of the wireless connection with a search frequency f.sub.2<f.sub.1.

[0114] In particular, the time t.sub.s can be a predetermined time or can be calculated on the basis of the overall time necessary to complete the emergency navigation. For example, t.sub.s can be a predetermined percentage of the estimated time required to complete reaching the desired destination or to make an early landing in the emergency navigation mode.

[0115] Alternatively, or in combination, the control unit can move from the search frequency f.sub.1 to the search frequency f.sub.2 when the value E.sub.res falls below a predetermined threshold or upon reaching a predetermined percentage of the section to be carried out to complete the emergency navigation.

[0116] In this way, the control unit can gradually reduce the energy consumption used to search for the wireless connection signal as emergency navigation approaches its end. For example, after a certain time or a certain percentage of the route completed in the emergency navigation mode, the control unit can completely stop checking the connection status, as resuming navigation remotely would no longer be convenient.

[0117] In particular, when the drone enters the landing phase during emergency navigation, this procedure cannot be interrupted by the remote-control station. This is because, once the landing phase has begun, it is no longer convenient to interrupt this phase, but rather complete the landing and perform a new take-off.

[0118] The foregoing description exemplary embodiments of the invention will so fully reveal the invention according to the conceptual point of view, so that others, by applying current knowledge, will be able to modify and/or adapt for various applications such embodiment without further research and without parting from the invention, and, accordingly, it is therefore to be understood that such adaptations and modifications will have to be considered as equivalent to the specific embodiments. The means and the materials to realise the different functions described herein could have a different nature without, for this reason, departing from the field of the invention. It is to be understood that the phraseology or terminology that is employed herein is for the purpose of description and not of limitation.