Autonomous positioning, tracking and monitoring method and equipment for UAVs of fault survey ships
By building a positioning tracking model and controller, controlling the drone to track and monitor the yaw of the ocean survey ship, the problem of the inability to effectively monitor and correct the yaw of the ocean survey ship in the existing technology is solved, and efficient use of resources is achieved.
Patent Information
- Application Number
- CN202411020419.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-29
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-07-29
AI Technical Summary
The existing technology cannot effectively monitor and correct the yaw of marine survey ships, resulting in waste of survey resources. Simple drone high-altitude monitoring cannot issue effective reminders or track faulty survey ships that deviate from the route.
By constructing a positioning tracking model based on the heading angle and speed of the fault survey ship, determining the objective function and controller, controlling the drone to fly over the fault survey ship, issuing sound and light warnings and performing real-time shooting, ensuring that the drone can track and monitor it A survey ship that is yawing.
When the faulty survey ship still stagnates when it receives a warning, it can conduct on-site warnings and tracking to avoid wasting survey resources and ensure that the drone can hover over the faulty survey ship and conduct effective monitoring.
Smart Images

Figure CN118584976B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present invention relate to the field of unmanned aerial vehicle control technology, and in particular to a method and device for autonomous positioning, tracking and monitoring of an unmanned aerial vehicle for a fault survey ship. Background Art
[0002] At present, surveying a specific sea area requires the collaboration of multiple ocean survey ships. Due to improper human operation or hull failure, the ocean survey ship will deviate from the scheduled survey route, which requires monitoring of the ocean survey ship. The current monitoring mainly relies on drones for high-altitude photography. In actual monitoring, there have been cases where the faulty monitoring ship has not corrected the route after receiving the warning. This is usually due to the failure of the survey ship driver to find the deviation warning in time. However, simple drone high-altitude monitoring cannot issue effective reminders to survey ships that deviate from the route, and once the faulty survey ship leaves the monitoring area, its route cannot be tracked, resulting in the survey ship yawing for a long time, resulting in a waste of survey resources. Therefore, the development of a drone autonomous positioning tracking monitoring method and equipment for faulty survey ships can effectively overcome the defects in the above-mentioned prior art, which has become a technical problem that needs to be solved urgently in the industry. Summary of the invention
[0003] In view of the above problems existing in the prior art, an embodiment of the present invention provides a method and device for autonomous positioning, tracking and monitoring of a UAV for a fault survey ship.
[0004] In a first aspect, an embodiment of the present invention provides an autonomous positioning, tracking and monitoring method for a fault survey ship using an unmanned aerial vehicle, comprising: constructing a first positioning and tracking model according to the heading angle and speed of the fault survey ship; calculating in real time the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and constructing constraint conditions of the positioning and tracking model according to the calculation results; determining an objective function for positioning and tracking the fault survey ship by the unmanned aerial vehicle, constructing a second positioning and tracking model according to the objective function and the first positioning and tracking model, obtaining a third positioning and tracking model according to the first positioning and tracking model and the second positioning and tracking model, and constructing a positioning and tracking controller for the third positioning and tracking model; using the positioning and tracking controller to control the unmanned aerial vehicle to fly over the fault survey ship, the unmanned aerial vehicle issues an audible and visual warning to the fault survey ship, and takes real-time photos of the fault survey ship.
[0005] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the first positioning and tracking model is constructed according to the heading angle and speed of the fault survey ship, comprises:
[0006] ,
[0007] ,
[0008] Where D is the distance from the vertical projection of the UAV on the sea level to the fault survey ship; Speed of the survey vessel for faults; is the angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system; is the angle between the vertical projection of the UAV on the sea level, the line connecting the fault survey ship and the horizontal axis of the sea level coordinate system; is the vertical projection speed of the UAV on the sea level; is the angle between the vertical projection velocity direction of the UAV on the sea level and the horizontal axis of the sea level coordinate system; cos is the sign of the cosine; sin is the sign of the sine; Find the sign of the first derivative with respect to duration.
[0009] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method for a fault survey ship provided in the embodiment of the present invention by a UAV includes real-time calculation of the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and construction of the constraint conditions of the positioning and tracking model according to the calculation results, including: , is a constant or piecewise constant, and .
[0010] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, the objective function of determining the positioning and tracking of the fault survey ship by the UAV includes:
[0011] ,
[0012] Among them, lim is the limit symbol; t is the duration; To approach the symbol; is the infinity symbol; then , ensuring that the drone hovers over the faulty survey ship.
[0013] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the second positioning and tracking model is constructed according to the objective function and the first positioning and tracking model, comprises:
[0014] ,
[0015] ,
[0016] in, is the first intermediate variable; It is the second positioning and tracking model.
[0017] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the third positioning and tracking model is obtained according to the first positioning and tracking model and the second positioning and tracking model, comprises:
[0018] ,
[0019] in, is the second intermediate variable; It is the third positioning tracking model.
[0020] Based on the content of the above method embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the positioning and tracking controller is constructed for the third positioning and tracking model, comprises:
[0021] ,
[0022] ,
[0023] Where, u is the positioning tracking controller; For The estimated value of; K is the control parameter; is a constant greater than zero.
[0024] In the second aspect, an embodiment of the present invention provides an autonomous positioning, tracking and monitoring device for a fault survey ship using a UAV, including: a first main module, used to realize the construction of a first positioning and tracking model according to the heading angle and speed of the fault survey ship; a second main module, used to realize the real-time measurement of the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and to construct the constraint conditions of the positioning and tracking model according to the measurement results; a third main module, used to realize the determination of the objective function of the UAV positioning and tracking of the fault survey ship, to construct a second positioning and tracking model according to the objective function and the first positioning and tracking model, to obtain a third positioning and tracking model according to the first positioning and tracking model and the second positioning and tracking model, and to construct a positioning and tracking controller for the third positioning and tracking model; a fourth main module, used to realize the use of the positioning and tracking controller to control the UAV to fly over the fault survey ship, the UAV issues an audible and visual warning to the fault survey ship, and takes real-time photos of the fault survey ship.
[0025] In a third aspect, an embodiment of the present invention provides an electronic device, including:
[0026] At least one processor, at least one memory and a communication interface; wherein,
[0027] The processor, memory and communication interface communicate with each other;
[0028] The memory stores program instructions that can be executed by the processor, and the processor calls the program instructions to execute the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided by any one of the various implementations of the first aspect.
[0029] In a fourth aspect, an embodiment of the present invention provides a non-transitory computer-readable storage medium, which stores computer instructions, and the computer instructions enable a computer to execute the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided by any one of the various implementation methods of the first aspect.
[0030] The embodiment of the present invention provides an autonomous positioning, tracking and monitoring method and device for a fault survey ship using a drone. A first positioning and tracking model is constructed through the heading angle and speed of the fault survey ship, and an objective function for positioning and tracking the fault survey ship using the drone is determined. A second positioning and tracking model and a third positioning and tracking model are constructed based on the objective function and the first positioning and tracking model. A positioning and tracking controller is constructed for the third positioning and tracking model to control the drone to perform aerial monitoring of the fault survey ship. In the event that the fault monitoring ship still deviates after receiving a warning, the fault detection ship can be given an on-site warning and tracked, thereby avoiding a waste of survey resources. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, a brief introduction is given below to the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0032] Figure 1 A schematic flow chart of a method for autonomous positioning, tracking and monitoring of a fault survey ship by a UAV provided in an embodiment of the present invention;
[0033] Figure 2 A schematic diagram of the structure of an autonomous positioning, tracking and monitoring device for a UAV for a fault survey ship provided by an embodiment of the present invention;
[0034] Figure 3 A schematic diagram of the physical structure of an electronic device provided by an embodiment of the present invention;
[0035] Figure 4 A schematic diagram of the control effect of the autonomous positioning and tracking of a fault survey ship by a UAV provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0036] In order to make the purpose, technical scheme and advantages of the embodiment of the present invention clearer, the technical scheme in the embodiment of the present invention will be clearly and completely described in conjunction with the drawings in the embodiment of the present invention. Obviously, the described embodiment is a part of the embodiment of the present invention, not all of the embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in the field without creative work are within the scope of protection of the present invention. In addition, the technical features in the various embodiments or single embodiments provided by the present invention can be combined with each other arbitrarily to form a feasible technical solution. This combination is not subject to the constraints of the sequence of steps and / or the structural composition mode, but must be based on the ability of ordinary technicians in the field to achieve. When the combination of technical solutions is contradictory or cannot be achieved, it should be considered that the combination of such technical solutions does not exist and is not within the scope of protection required by the present invention. If there are step numbers in the following embodiments, they are only set for the convenience of explanation, and the order between the steps is not limited in any way. The execution order of each step in the embodiment can be adaptively adjusted according to the understanding of those skilled in the art.
[0037] The embodiment of the present invention provides a method for autonomous positioning, tracking and monitoring of a UAV for a fault survey ship, see Figure 1 The method includes: constructing a first positioning and tracking model according to the heading angle and speed of the fault survey ship; calculating the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship in real time, and constructing the constraint conditions of the positioning and tracking model according to the calculation results; determining the objective function of the UAV positioning and tracking of the fault survey ship, constructing a second positioning and tracking model according to the objective function and the first positioning and tracking model, obtaining a third positioning and tracking model according to the first positioning and tracking model and constructing a positioning and tracking controller for the third positioning and tracking model; using the positioning and tracking controller to control the UAV to fly over the fault survey ship, the UAV issues an audible and visual warning to the fault survey ship, and takes real-time photos of the fault survey ship.
[0038] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the first positioning and tracking model is constructed according to the heading angle and speed of the fault survey ship, comprises:
[0039] (1)
[0040] (2)
[0041] Where D is the distance from the vertical projection of the UAV on the sea level to the fault survey ship; Speed of the survey vessel for faults; is the angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system; is the angle between the vertical projection of the UAV on the sea level, the line connecting the fault survey ship and the horizontal axis of the sea level coordinate system; is the vertical projection speed of the UAV on the sea level; is the angle between the vertical projection velocity direction of the UAV on the sea level and the horizontal axis of the sea level coordinate system; cos is the sign of the cosine; sin is the sign of the sine; Find the sign of the first derivative with respect to duration.
[0042] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method for a fault survey ship provided by an unmanned aerial vehicle in an embodiment of the present invention, the real-time calculation of the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and the construction of the constraint conditions of the positioning and tracking model according to the calculation results, include: , is a constant or piecewise constant, and .
[0043] It should be noted that What it means is that the vertical projection speed of the UAV on the sea level must always be greater than the speed of the fault survey ship, so as to ensure that the UAV catches up with the fault survey ship; The meaning of being a constant or a piecewise constant is that the heading change of the fault survey ship is fixed or piecewise fixed, which is consistent with the actual fault condition of the fault survey ship (such as the steering gear is stuck at a certain angle); What it means is to ensure that the flying direction of the drone is always towards the faulty survey ship.
[0044] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the objective function for determining the positioning and tracking of the fault survey ship by the UAV includes:
[0045] (3)
[0046] Among them, lim is the limit symbol; t is the duration; To approach the symbol; is the infinity symbol; then , to ensure that the UAV hovers over the fault survey ship. It should be noted that the meaning of formula (3) is to ensure that the UAV can finally hover over the fault survey ship, so it is necessary to ensure , if (3) holds, then we can ensure Established.
[0047] It should be noted that It means , due to any time interval , then , which ensures that the distance from the vertical projection of the UAV on the sea level to the fault survey ship is continuously shortened with the change of time, and finally ensures that the UAV hovers over the fault survey ship. In addition, when (3) holds, there is ,Right now , then we get , in D, and If it is greater than zero, it can be ensured .
[0048] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the second positioning and tracking model is constructed according to the objective function and the first positioning and tracking model, comprises:
[0049] (4)
[0050] (5)
[0051] in, is the first intermediate variable; is the second positioning tracking model. It should be noted that (4) contains the uncertainty term that needs to be eliminated by the synovial control law. In order to avoid using the synovial control law, it is necessary to further construct a third positioning tracking model as shown in formula (6).
[0052] It should be noted that formula (5) is essentially the same as formula (2). The reason for using formula (5) is to facilitate the design of the synovial control law. However, the sliding film control law has the problems of chattering and overshoot, so it is necessary to further transform equation (4) into equation (6) to facilitate the design of a more practical control law to avoid chattering and overshoot. The first-order derivative of equation (2) yields equation (4) as follows:
[0053] ,
[0054] Combining (1) with equation (4) yields equation (4).
[0055] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the third positioning and tracking model is obtained according to the first positioning and tracking model and the second positioning and tracking model, comprises:
[0056] (6)
[0057] in, is the second intermediate variable; is the third positioning and tracking model. It should be noted that by constructing the third positioning and tracking model as shown in formula (6), the uncertainty term is reduced to Therefore, the Lyapunov control rate can be designed as shown in formula (7) for corresponding control.
[0058] Based on the content of the above method embodiment, as an optional embodiment, the autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship provided in the embodiment of the present invention, wherein the positioning and tracking controller is constructed for the third positioning and tracking model, comprises:
[0059] (7)
[0060] (8)
[0061] Where, u is the positioning tracking controller; For The estimated value of; K is the control parameter; is a constant greater than zero. It should be noted that formula (8) is a Lyapunov constraint condition. and If the errors between the two satisfy equation (8), it can be ensured that when the positioning and tracking controller u controls the third positioning and tracking model shown in equation (6), the UAV can finally hover over the faulty survey ship.
[0062] For details on the control effect, see Figure 4 , the coordinate system is the sea level coordinate system, the initial position of the fault survey ship is point B (1300, 150) (the dotted line is the yaw trajectory of the fault survey ship), the initial position of the UAV is point A (10, 18) (the solid line is the flight trajectory of the UAV), and the initial speed of the fault survey ship is The initial speed of the drone is two meters per second. is four meters per second, the initial is 70 degrees, is 100 degrees, K is 0.3, is 0.001. It can be seen that under the control of the positioning and tracking controller expressed by equation (7), the UAV hovers above the fault survey ship at point C(200,166).
[0063] The embodiment of the present invention provides an autonomous positioning, tracking and monitoring method for a fault survey ship using a UAV. A first positioning and tracking model is constructed through the heading angle and speed of the fault survey ship, and an objective function for positioning and tracking the fault survey ship using the UAV is determined. A second positioning and tracking model and a third positioning and tracking model are constructed based on the objective function and the first positioning and tracking model. A positioning and tracking controller is constructed for the third positioning and tracking model to control the UAV to perform aerial monitoring of the fault survey ship. In the case where the fault monitoring ship still deviates after receiving a warning, the fault detection ship can be given an on-site warning and tracked, thereby avoiding a waste of survey resources.
[0064] The implementation basis of each embodiment of the present invention is to implement programmed processing through a device with a processor function. Therefore, in engineering practice, the technical solutions and functions of each embodiment of the present invention can be encapsulated into various modules. Based on this reality, on the basis of the above embodiments, an embodiment of the present invention provides an autonomous positioning, tracking and monitoring device for a UAV of a fault survey ship, which is used to execute the autonomous positioning, tracking and monitoring method for a UAV of a fault survey ship in the above method embodiment. Figure 2 The device includes: a first main module, which is used to build a first positioning and tracking model according to the heading angle and speed of the fault survey ship; a second main module, which is used to realize real-time measurement of the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and to build the constraint conditions of the positioning and tracking model according to the measurement results; a third main module, which is used to realize the objective function of determining the positioning and tracking of the fault survey ship by the unmanned aerial vehicle, to build a second positioning and tracking model according to the objective function and the first positioning and tracking model, to obtain a third positioning and tracking model according to the first positioning and tracking model and the second positioning and tracking model, and to build a positioning and tracking controller for the third positioning and tracking model; a fourth main module, which is used to realize the use of the positioning and tracking controller to control the unmanned aerial vehicle to fly over the fault survey ship, the unmanned aerial vehicle sends an audible and visual warning to the fault survey ship, and takes real-time photos of the fault survey ship.
[0065] The unmanned aerial vehicle autonomous positioning, tracking and monitoring device for a fault survey ship provided by the embodiment of the present invention adopts Figure 2 Several modules in it, build a first positioning and tracking model through the heading angle and speed of the fault survey ship, determine the objective function of the UAV positioning and tracking the fault survey ship, build a second positioning and tracking model and a third positioning and tracking model according to the objective function and the first positioning and tracking model, build a positioning and tracking controller for the third positioning and tracking model and control the UAV to perform aerial monitoring of the fault survey ship, so that the fault detection ship can be warned and tracked on the spot when the fault monitoring ship still deviates after receiving the warning, thus avoiding the waste of survey resources.
[0066] It should be noted that the device in the device embodiment provided by the present invention can be used to implement the method in the above method embodiment as well as the method in other method embodiments provided by the present invention. The only difference is that the corresponding functional modules are set, and the principle is basically the same as the principle of the above device embodiment provided by the present invention. As long as the technicians in this field refer to the specific technical solutions in other method embodiments on the basis of the above device embodiment, obtain the corresponding technical means and the technical solutions composed of these technical means by combining technical features, they can improve the device in the above device embodiment on the premise of ensuring the practicality of the technical solution, thereby obtaining the corresponding device class embodiment, which is used to implement the methods in other method class embodiments. For example.
[0067] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for the fault survey ship provided in the embodiment of the present invention further includes: a first submodule, which is used to implement the construction of the first positioning and tracking model according to the heading angle and speed of the fault survey ship, including:
[0068] ,
[0069] ,
[0070] Where D is the distance from the vertical projection of the UAV on the sea level to the fault survey ship; Speed of the survey vessel for faults; is the angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system; is the angle between the vertical projection of the UAV on the sea level, the line connecting the fault survey ship and the horizontal axis of the sea level coordinate system; is the vertical projection speed of the UAV on the sea level; is the angle between the vertical projection velocity direction of the UAV on the sea level and the horizontal axis of the sea level coordinate system; cos is the sign of the cosine; sin is the sign of the sine; Find the sign of the first derivative with respect to duration.
[0071] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for the fault survey ship provided in the embodiment of the present invention further includes: a second submodule, which is used to realize the real-time measurement of the angle between the movement direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and construct the constraint conditions of the positioning and tracking model according to the measurement results, including: , is a constant or piecewise constant, and .
[0072] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for a fault survey ship provided in the embodiment of the present invention further includes: a third submodule, which is used to implement the objective function of determining the positioning and tracking of the fault survey ship by the UAV, including:
[0073] ,
[0074] Among them, lim is the limit symbol; t is the duration; To approach the symbol; is the infinity symbol; then , ensuring that the drone hovers over the faulty survey ship.
[0075] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for a fault survey ship provided in the embodiment of the present invention further includes: a fourth submodule, which is used to implement the construction of the second positioning and tracking model according to the objective function and the first positioning and tracking model, including:
[0076] ,
[0077] ,
[0078] in, is the first intermediate variable; It is the second positioning and tracking model.
[0079] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for a fault survey ship provided in the embodiment of the present invention further includes: a fifth submodule, which is used to implement the third positioning and tracking model obtained according to the first positioning and tracking model and the second positioning and tracking model, including:
[0080] ,
[0081] in, is the second intermediate variable; It is the third positioning tracking model.
[0082] Based on the content of the above device embodiment, as an optional embodiment, the UAV autonomous positioning, tracking and monitoring device for a fault survey ship provided in the embodiment of the present invention further includes: a sixth submodule, which is used to implement the third positioning and tracking model to construct a positioning and tracking controller, including:
[0083] ,
[0084] ,
[0085] Where, u is the positioning tracking controller; For The estimated value of; K is the control parameter; is a constant greater than zero.
[0086] The method of the embodiment of the present invention is implemented by relying on electronic devices, so it is necessary to introduce the relevant electronic devices. Based on this purpose, the embodiment of the present invention provides an electronic device, such as Figure 3 As shown, the electronic device includes: at least one processor, a communication interface, at least one memory, and a communication bus, wherein at least one processor, the communication interface, and at least one memory communicate with each other through the communication bus. At least one processor can call the logic instructions in at least one memory to execute all or part of the steps of the method provided by the aforementioned various method embodiments.
[0087] In addition, the logic instructions in the at least one memory mentioned above can be implemented in the form of a software functional unit and can be stored in a computer-readable storage medium when it is sold or used as an independent product. Based on this understanding, the technical solution of the present invention can be essentially or partly embodied in the form of a software product that contributes to the prior art. The computer software product is stored in a storage medium and includes several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each method embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc., which can store program code.
[0088] The device embodiments described above are merely illustrative, wherein the units described as separate components may or may not be physically separated, and the components displayed as units may or may not be physical units, that is, they may be located in one place, or they may be distributed on multiple network units. Some or all of the modules may be selected according to actual needs to achieve the purpose of the scheme of this embodiment. Ordinary technicians in this field can understand and implement it without paying creative labor.
[0089] Through the description of the above implementation methods, those skilled in the art can clearly understand that each implementation method can be implemented by means of software plus a necessary general hardware platform, and of course can also be implemented by hardware. Based on this understanding, the above technical solution is essentially or the part that contributes to the prior art can be embodied in the form of a software product, and the computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, a disk, an optical disk, etc., including a number of instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to execute the methods described in each embodiment or some parts of the embodiments.
[0090] The flowcharts and block diagrams in the accompanying drawings show the possible architecture, functions and operations of the systems, methods and computer program products according to multiple embodiments of the present invention. Based on this understanding, each box in the flowchart or block diagram can represent a module, a program segment or a part of a code, and the module, a program segment or a part of the code contains one or more executable instructions for realizing the specified logical function. It should also be noted that in some alternative implementations, the functions marked in the box can also occur in a different order from the order marked in the accompanying drawings. For example, two consecutive boxes can actually be executed substantially in parallel, and sometimes in the opposite order, depending on the functions involved. It should also be noted that each box in the block diagram and / or the flowchart, and the combination of the boxes in the block diagram and / or the flowchart can be implemented with a dedicated hardware-based system that performs a specified function or action, or can be implemented with a combination of dedicated hardware and computer instructions.
[0091] It should be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also includes other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "includes..." do not exclude the existence of other identical elements in the process, method, article or device including the elements. Any "predetermined threshold", "preset threshold" and other similar expressions that do not indicate specific values can be determined by a person of ordinary skill in the art through simple experiments or corresponding debugging.
[0092] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or make equivalent replacements for some of the technical features therein. However, these modifications or replacements do not deviate the essence of the corresponding technical solutions from the spirit and scope of the technical solutions of the embodiments of the present invention.
Claims
1. A method for autonomous positioning, tracking and monitoring of a UAV for a fault survey ship, characterized in that: include: Constructing a first positioning and tracking model according to the heading angle and speed of the fault survey vessel; The angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship are calculated in real time, and the constraint conditions of the positioning and tracking model are constructed according to the calculation results; the objective function of the UAV positioning and tracking the fault survey ship is determined, and a second positioning and tracking model is constructed according to the objective function and the first positioning and tracking model, and a third positioning and tracking model is obtained according to the first positioning and tracking model and the second positioning and tracking model, and a positioning and tracking controller is constructed for the third positioning and tracking model; the positioning and tracking controller is used to control the UAV to fly over the fault survey ship, and the UAV issues an audible and visual warning to the fault survey ship and takes real-time photos of the fault survey ship; the first positioning and tracking model is constructed according to the heading angle and speed of the fault survey ship, including: Where D is the distance from the vertical projection of the UAV on the sea level to the fault survey ship; V G is the speed of the fault survey ship; θ G is the angle between the motion direction of the fault survey ship and the horizontal axis of the sea level coordinate system; β is the angle between the vertical projection of the UAV on the sea level and the connecting line of the fault survey ship and the horizontal axis of the sea level coordinate system; V F is the speed of the vertical projection of the UAV on the sea level; θ F is the angle between the vertical projection speed direction of the UAV on the sea level and the horizontal axis of the sea level coordinate system; cos is the sign of the cosine; sin is the sign of the sine; · is the sign of the first-order derivative with respect to the duration; the second positioning and tracking model is constructed according to the objective function and the first positioning and tracking model, including: Among them, σ is the first intermediate variable; is the second positioning tracking model; the third positioning tracking model is obtained according to the first positioning tracking model and the second positioning tracking model, including: Among them, σ0 is the second intermediate variable; The third positioning tracking model is constructed as a positioning tracking controller for the third positioning tracking model, including: Where u is the positioning tracking controller; θ G0 For θ G is an estimated value of ; K is a control parameter; η is a constant greater than zero.
2. The autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship according to claim 1 is characterized in that: The real-time calculation of the angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and the construction of the constraint conditions of the positioning and tracking model according to the calculation results, include: V G <V F , is a constant or piecewise constant, and |θ F -β|<90°.
3. The autonomous positioning, tracking and monitoring method of a UAV for a fault survey ship according to claim 2 is characterized in that: The objective function of determining the positioning and tracking of the fault survey ship by the UAV includes: Among them, lim is the symbol for finding the limit; t is the duration; → is the symbol for approaching; ∞ is the symbol for infinity; then Make sure the drone is hovering over the faulty survey ship.
4. An autonomous positioning, tracking and monitoring device for a UAV on a fault survey ship, characterized in that: include: The first main module is used to build a first positioning and tracking model according to the heading angle and speed of the fault survey ship; The second main module is used to realize real-time measurement of the angle between the moving direction of the fault survey ship and the horizontal axis of the sea level coordinate system and the speed of the fault survey ship, and to construct the constraint conditions of the positioning and tracking model according to the measurement results; The third main module is used to implement the objective function of determining the positioning and tracking of the fault survey ship by the UAV, construct the second positioning and tracking model according to the objective function and the first positioning and tracking model, obtain the third positioning and tracking model according to the first positioning and tracking model and construct a positioning and tracking controller for the third positioning and tracking model; the fourth main module is used to implement the positioning and tracking controller to control the UAV to fly over the fault survey ship, the UAV issues an audible and visual warning to the fault survey ship, and takes real-time photos of the fault survey ship; the first positioning and tracking model is constructed according to the heading angle and speed of the fault survey ship, including: Where D is the distance from the vertical projection of the UAV on the sea level to the fault survey ship; V G is the speed of the fault survey ship; θ G is the angle between the motion direction of the fault survey ship and the horizontal axis of the sea level coordinate system; β is the angle between the vertical projection of the UAV on the sea level and the connecting line of the fault survey ship and the horizontal axis of the sea level coordinate system; V F is the speed of the vertical projection of the UAV on the sea level; θ F is the angle between the vertical projection speed direction of the UAV on the sea level and the horizontal axis of the sea level coordinate system; cos is the sign of the cosine; sin is the sign of the sine; · is the sign of the first-order derivative with respect to the duration; the second positioning and tracking model is constructed according to the objective function and the first positioning and tracking model, including: Among them, σ is the first intermediate variable; is the second positioning tracking model; the third positioning tracking model is obtained according to the first positioning tracking model and the second positioning tracking model, including: Among them, σ0 is the second intermediate variable; The third positioning tracking model is constructed as a positioning tracking controller for the third positioning tracking model, including: Where u is the positioning tracking controller; θ G0 For θ G is an estimated value of ; K is a control parameter; η is a constant greater than zero.
5. An electronic device, characterized in that: include: At least one processor, at least one memory and a communication interface; wherein, The processor, memory and communication interface communicate with each other; The memory stores program instructions that can be executed by the processor, and the processor calls the program instructions to execute the method according to any one of claims 1 to 3.
6. A non-transitory computer-readable storage medium, characterized in that: The non-transitory computer-readable storage medium stores computer instructions, which cause a computer to execute the method of any one of claims 1 to 3.
Citation Information
Patent Citations
Target object grabbing method and device of unmanned plane, and electronic device
CN108733076A
Unmanned aerial vehicle monitoring and tracking method, device and equipment and storage medium
CN113759986A
Unmanned aerial vehicle control method, device and equipment and computer storage medium
CN114527783A
KR20200114858A
