Summary of the invention
Given this, the embodiment of the present invention provides a kind of unmanned plane during flying track method for drafting, device and system, to solveIn prior art, after unmanned plane loss signal, cause user to the position of unmanned plane cannot control problem.
The invention provides a kind of unmanned plane during flying track method for drafting, method comprises: planning unmanned plane during flying destination withAnd flight path; Every setting-up time interval receives the position signalling returning in unmanned plane during flying process, according to position signalling at electricityOn sub-map, draw the flight path of unmanned plane; If cannot receive position signalling in setting-up time, arrange lastThe position that receives the corresponding electronic chart of position signalling starts to draw virtual track as the starting point of virtual track, with lastThe inferior simulated flight speed that the flying speed of unmanned plane is unmanned plane while receiving position signalling, according to the orientation determination of destination withoutThe man-machine heading in current location, then determine unmanned plane during flying setting-up time according to simulated flight speed and headingThe next position arriving behind interval, then on electronic chart, draw the virtual track of unmanned plane according to the next position.
Preferably, in the planning destination of unmanned plane during flying and the step of flight path, comprising: on electronic chart, establishPut the flight path of unmanned plane; On flight path, select the destination of unmanned plane during flying; Calculate the distance of each destination to takeoff pointFrom and determine the direction of each destination.
Preferably, according to the orientation determination unmanned plane of destination at current location heading, then according to simulated flight speedAnd heading determines the step of the next position arriving behind unmanned plane during flying setting-up time interval, comprising: fly according to simulationThe total distance of flight when line speed is calculated unmanned plane arrival the next position; Judging whether the total distance of flight is greater than the next one will be throughThe destination of crossing is to the distance of takeoff point; If be greater than the distance of next destination to takeoff point, and continue to judge a upper warpWhether the heading of the destination of crossing is inconsistent with the heading of next destination; If inconsistent, will with the next oneThe heading of the destination of process, as the heading in current location of unmanned plane, calculates the total distance of flight and navigates with the next onePoint is to the difference of the distance of takeoff point, along heading at the difference place at a distance of the next destination that will pass through as unmannedThe next position that machine arrives, otherwise the heading that continues the destination of an above process is unmanned plane flying in current locationLine direction, calculates the total distance of flight and the difference of next destination to the distance of takeoff point, along heading apart nextThe next position that the difference place of individual destination arrives as unmanned plane; If being less than or equal to the destination that the next one will arrive arrivesThe distance of flying spot, the direction of selecting the destination of a process is the heading of unmanned plane in current location, total by flyingDistance is determined the next position.
Preferably, if cannot receive position signalling in setting-up time, arrange and receive for the last time position letterThe position of number corresponding electronic chart starts to draw in the step of virtual track as the starting point of virtual track, comprising: electricity is setSub-map, is just opened counting the virtual track of setting-up time formation from receiving for the last time position signalling at demonstration unmanned planeBegin to draw virtual track.
Preferably, calculate each destination to the distance of takeoff point and determine that the step of the direction of each destination comprises: withThe center of electronic chart is the origin of coordinates; Obtain the coordinate of takeoff point position on electronic chart corresponding to destination; By risingThe coordinate of flying spot and destination and, the ratio of coordinate between destination and electronic chart and actual range calculates destination and apart takes offThe distance of point, the coordinate by takeoff point and destination and, the vector of coordinate calculating destination between destination determines the side of destinationTo.
Preferably, position signalling is gps signal.
The present invention also provides a kind of unmanned plane during flying track drawing apparatus, and device comprises: planning module, and unmanned in order to planDestination and the flight path of machine flight; Reality track drafting module, receives unmanned plane during flying mistake in order to every setting-up time intervalThe position signalling returning in journey, the flight path of drawing unmanned plane according to position signalling on electronic chart; Virtual track is drawnModule, if in order to cannot receive position signalling in setting-up time, arranges and receives for the last time the corresponding electricity of position signallingThe position of sub-map starts to draw virtual track as the starting point of virtual track, when receiving position signalling for the last time withoutMan-machine flying speed is the simulated flight speed of unmanned plane, according to the orientation determination unmanned plane of destination in current location flight sideTo, then determine according to simulated flight speed and heading the next position arriving behind unmanned plane during flying setting-up time interval,On electronic chart, draw again the virtual track of unmanned plane according to the next position.
Preferably, planning module comprises: setting unit, in order to the flight path of unmanned plane to be set on electronic chart; ChoosingSelect unit, in order to select the destination of unmanned plane during flying on flight path; Computing unit, in order to calculate each destination to takeoff pointDistance and determine the direction of each destination.
Preferably, virtual track drafting module, comprising: the first computing unit, and in order to calculate each destination to takeoff pointThe direction of distance and definite each destination; The second computing unit, in order to calculate under unmanned plane arrival according to simulated flight speedThe total distance of flight when one position; Judging unit, in order to judge whether the total distance of flight is greater than the destination that the next one will pass throughTo the distance of takeoff point; Primary importance determining unit, in order to if be greater than the distance of next destination to takeoff point, and continuesWhether the heading of destination that judges a upper process is inconsistent with the heading of next destination; If inconsistent,The heading of the destination that will pass through using the next one, as the heading in current location of unmanned plane, calculates the total distance of flightFrom with the difference of next destination to the distance of takeoff point, poor along heading at a distance of the next destination that will pass throughThe next position that value place arrives as unmanned plane, otherwise the heading that continues the destination of an above process is that unmanned plane existsThe heading of current location, calculates the total distance of flight and the difference of next destination to the distance of takeoff point, along flight sideThe next position arriving as unmanned plane to the difference place at a distance of next destination; Second place determining unit, if in order toBe less than or equal to destination that the next one will the arrive distance to takeoff point, select the direction of destination of a process for unmannedMachine is at the heading of current location, and by flying, total distance is determined the next position.
The present invention also provides a kind of unmanned plane during flying track drawing system, and system comprises unmanned plane during flying rail as aboveMark drawing apparatus.
Compare with prior art, the invention has the beneficial effects as follows: unmanned plane during flying track method for drafting of the present invention, deviceAnd system, determine the position of unmanned plane by simulated flight speed and the flying method of unmanned plane, thereby draw unmanned planeVirtual track after loss signal, can allow unmanned plane operator after unmanned plane lost contact, still can estimate the present bit of unmanned planePut, thereby do some preparations to reclaiming unmanned plane, alleviate the psychological pressure of bringing to user because of the temporary transient loss signal of unmanned plane,Improve the success rate that unmanned plane reclaims.
Detailed description of the invention
In order to make object of the present invention, technical scheme and advantage clearer, below in conjunction with drawings and Examples, rightThe present invention is further elaborated. Should be appreciated that specific embodiment described herein is only in order to explain the present invention, andBe not used in restriction the present invention.
Refer to Fig. 1, a kind of unmanned plane during flying track method for drafting of the present invention, method comprises:
Step S10: destination and the flight path of planning unmanned plane during flying. In the present embodiment, manipulator comes by control terminalDestination and the flight path of flight are set.
In the present embodiment, step S10 comprises:
Step S20: the flight path that described unmanned plane is set on electronic chart;
Step S21: the destination of selecting described unmanned plane during flying on described flight path;
Step S22: calculate the direction of each described destination to the distance of takeoff point and definite described each destination.
Here need to illustrate, destination is not both air line distance to the distance of takeoff point, but unmanned planeFly to the flying distance of destination from takeoff point. Such as, unmanned plane has passed through destination A, destination B from takeoff point M successively flight. BoatPoint B is that destination A adds that to the distance of takeoff point M destination B is to the distance between destination A to the distance of takeoff point M.
Step S22 specifically comprises:
Step S30: taking the center of electronic chart as the origin of coordinates;
Step S31: the coordinate that obtains takeoff point position on electronic chart corresponding to destination;
Step S32: by the ratio of the coordinate between coordinate, the destination of takeoff point and destination and electronic chart and actual rangeCalculate the distance of destination at a distance of takeoff point, calculate the vector of destination by the coordinate between coordinate and the destination of takeoff point and destinationDetermine the direction of destination.
Step S11: every setting-up time interval receives the position signalling returning in unmanned plane during flying process, according to position signallingOn electronic chart, draw the flight path of unmanned plane.
In the present embodiment, setting-up time is spaced apart 0.5S. Also be, unmanned plane returns to position signalling one time every 0.5S,Electronic chart is the position on map every unmanned plane of 0.5S renewal, and draws the flight rail of unmanned plane according to positionMark.
Step S12: if cannot receive position signalling in setting-up time, arrange and receive for the last time position signallingThe position of corresponding electronic chart starts to draw virtual track as the starting point of virtual track, to receive for the last time position letterNumber time unmanned plane the flying speed simulated flight speed that is unmanned plane, according to the orientation determination unmanned plane of destination in current locationHeading, then determine next arrival behind unmanned plane during flying setting-up time interval according to simulated flight speed and headingPosition, then on electronic chart, draw the virtual track of unmanned plane according to the next position.
In the present embodiment, setting-up time is 4S. If cannot receiving position signal in 4S, unmanned plane on electronic chartPosition can not be upgraded, and on electronic chart, represents that the cursor of unmanned plane can be static.
In step S12, electronic chart is set and draws showing after the virtual track that forms in setting-up time of unmanned planeVirtual track.
Although not home position signal of unmanned plane in setting-up time,, unmanned plane still awing, for fear ofThe inconsistent situation of flight of the virtual track showing on control terminal and unmanned plane reality, after setting-up time, directlyOn electronic chart, show the virtual track forming in this setting-up time, and then carry out void on the basis of this section of virtual trackIntend the drafting of track. The situation of virtual track reflection is just more accurate like this.
Refer to Fig. 2, according to the orientation determination unmanned plane of destination at current location heading, then according to simulated flight speedDegree and heading are determined the step of the next position arriving behind unmanned plane during flying setting-up time interval, comprising:
Step S40: calculate the direction of each destination to the distance of takeoff point and definite each destination;
Step S41: the total distance of flight while calculating unmanned plane arrival the next position according to simulated flight speed;
Step S42: judge whether the total distance of flight is greater than destination that the next one will the pass through distance to takeoff point;
Step S43: if be greater than the distance of next described destination to takeoff point, and continue judge a upper process described inWhether the heading of destination is inconsistent with the heading of the described destination of the next one; If inconsistent, will with the next oneThe heading of the described destination of process, as the heading in current location of described unmanned plane, calculates the total distance of described flightFrom with the difference of the described destination of the next one to the distance of described takeoff point, along described heading will be through at a distance of the next oneThe next position that the difference place of the described destination of crossing arrives as described unmanned plane, otherwise, continue an above process described inThe heading of destination is the heading of described unmanned plane in described current location, calculates the total distance of described flight and the next oneDescribed destination is to the difference of the distance of described takeoff point, along described heading at the difference place at a distance of next described destinationThe next position arriving as described unmanned plane;
Step S44: if be less than or equal to destination that the next one will the arrive distance to takeoff point, select a processThe direction of destination is the heading of unmanned plane in current location, and by flying, total distance is determined the next position.
Describe unmanned plane during flying track method for drafting of the present invention in detail below in conjunction with Fig. 1 to Fig. 3.
First, user has planned takeoff point A1, destination A2 and destination A3, and flight path is for from the A1 A2 that flies, fromThe A2 A3 that flies, finally from the A3 A1 that flies back. Through measuring and calculating, destination A2 is T1 to the distance of takeoff point A1, and destination A3 is to takeoff pointThe distance of A1 is T2+T1, is T3+T2+T1 from takeoff point A1 through destination A2, A3 to the distance of A1.
Loss signal while supposing that unmanned plane F flies F point between destination A2 and destination A3, now represents on electronic chartThe cursor of unmanned plane is static on track time, and no longer forms track. Through setting-up time, after 4 seconds, confirm nothingMan-machine lost contact, starts to draw this void after the virtual track N1 now forming in setting-up time at demonstration unmanned plane on electronic chartIntend track. Also be, taking the F1 on scheming as starting point, to start to draw virtual track.
Suppose that the current position of unmanned plane is F1, while receiving position signalling for the last time due to unmanned plane at F place, because ofThis, the simulated flight speed that the speed of unmanned plane in the time of F place is unmanned plane. Again because every setting-up time interval upgrade once withoutMan-machine position, the numerical value obtaining by the simulated flight speed time of being multiplied by adds that the distance that unmanned plane has flown can countCalculating is M1+M2 to unmanned plane distance next time, and total distance of unmanned plane during flying is that the distance of having flown adds M1 and M2Value. As we can see from the figure, total distance of unmanned plane during flying is greater than destination A3 that the next one will the pass through distance to takeoff pointFrom T2+T1, calculating the total distance of flight is M2 with next destination to the difference of the distance of takeoff point, and the side of next destinationTo for to fly to destination A1 from destination A3, determine the next position arriving for unmanned plane at the distance M2 place at a distance of destination A3F2, and unmanned plane is unanimously from destination A3 to destination A4 in the direction of position F2 with destination A3.
Also have a kind of situation to be, total distance that unmanned plane flies after from current location to the next position is not more than next boatPoint is to the distance of takeoff point, such as unmanned plane takes off from F1, behind setting-up time interval, still F1 and destination A3 itBetween, now, heading is still also consistent to the direction of destination A3 from destination A2 with the direction of destination A2, under unmanned planeThe position that position is F1 adds that simulated flight speed is multiplied by the distance at setting-up time interval.
Refer to Fig. 4, a kind of unmanned plane during flying track drawing apparatus of the present invention, device comprises:
Planning module 10, in order to plan destination and the flight path of unmanned plane during flying;
Reality track drafting module 20, receives the position signalling returning in unmanned plane during flying process in order to every setting-up time interval,On electronic chart, draw the flight path of unmanned plane according to position signalling;
Virtual track drafting module 30, if in order to cannot receive position signalling in setting-up time, arrange for the last time and connectThe position of receiving the corresponding electronic chart of position signalling starts to draw virtual track as the starting point of virtual track, with for the last timeThe simulated flight speed that while receiving position signalling, the flying speed of unmanned plane is unmanned plane, unmanned according to the orientation determination of destinationMachine is at current location heading, then determines unmanned plane during flying setting-up time interval according to simulated flight speed and headingThe next position of rear arrival, then on electronic chart, draw the virtual track of unmanned plane according to the next position.
Planning module 10 comprises:
Setting unit, in order to arrange the flight path of unmanned plane on electronic chart;
Selected cell, in order to select the destination of unmanned plane during flying on flight path;
Computing unit, in order to calculate the direction of each destination to the distance of takeoff point and definite each destination.
Computing unit comprises:
Initial point obtains subelement: taking the center of electronic chart as the origin of coordinates;
Coordinate obtains subelement: the coordinate that obtains takeoff point position on electronic chart corresponding to destination;
Operator unit: by the coordinate between coordinate, the destination of takeoff point and destination and electronic chart and actual rangeRatio is calculated destination at a distance of the distance of takeoff point, by the coordinate calculating destination between coordinate and the destination of takeoff point and destinationVector is determined the direction of destination.
Virtual track drafting module 30, comprising:
The first computing unit, in order to calculate the direction of each destination to the distance of takeoff point and definite each destination;
The second computing unit, the total distance of flight while arriving the next position in order to calculate unmanned plane according to simulated flight speed;
Judging unit, in order to judge whether the total distance of flight is greater than destination that the next one will the pass through distance to takeoff point;
Primary importance determining unit, in order to if be greater than the distance of next destination to takeoff point, and continues to judge upper oneWhether the heading of the destination of process is inconsistent with the heading of next destination; If inconsistent, will with the next oneThe heading of the destination passing through, as the heading in current location of unmanned plane, calculates the total distance of flight and the next oneDestination is to the difference of the distance of takeoff point, along heading at the difference place at a distance of the next destination that will pass through as nothingThe next position of man-machine arrival, otherwise the heading that continues the destination of an above process is unmanned plane in current locationHeading, calculates the total distance of flight and the difference of next destination to the distance of takeoff point, along heading under apartThe next position that the difference place of a destination arrives as unmanned plane;
Second place determining unit, if in order to be less than or equal to destination that the next one will the arrive distance to takeoff point, choosingThe direction of selecting the destination of a process is the heading of unmanned plane in current location, and by flying, total distance is determined next bitPut.
Virtual track drafting module 30 also comprises:
Adding device, arranges electronic chart and is counting setting-up time shape at demonstration unmanned plane from receiving for the last time position signallingAfter the virtual track becoming, just start to draw described virtual track.
Refer to Fig. 4, a kind of unmanned plane during flying track drawing system of the present invention, comprises above-mentioned unmanned plane during flying trackDrawing apparatus.
It should be noted that the present invention is except being applied in unmanned plane, can be applied in drive recorder, Flying CameraMachine, full-view camera and automobile etc.
Compare with prior art, the invention has the beneficial effects as follows: unmanned plane during flying track method for drafting of the present invention, deviceAnd system, determine the position of unmanned plane by simulated flight speed and the flying method of unmanned plane, thereby draw unmanned planeVirtual track after loss signal, can allow unmanned plane operator after unmanned plane lost contact, still can estimate the present bit of unmanned planePut, thereby do some preparations to reclaiming unmanned plane, alleviate the psychological pressure of bringing to user because of the temporary transient loss signal of unmanned plane,Improve the success rate that unmanned plane reclaims.
Those of ordinary skill in the art can recognize, the list of each example of describing in conjunction with embodiment disclosed hereinUnit and algorithm steps, can realize with the combination of electronic hardware or computer software and electronic hardware. These functions actuallyCarry out with hardware or software mode, depend on application-specific and the design constraint of technical scheme. Professional and technical personnelCan realize described function with distinct methods to each specifically should being used for, but this realization should not be thought and exceedScope of the present invention.
Those skilled in the art can be well understood to, for convenience and simplicity of description, the system of foregoing description,The specific works process of device and unit, can, with reference to the corresponding process in preceding method embodiment, not repeat them here.
In the several embodiment that provide in the application, should be understood that, disclosed apparatus and method, can pass through itIts mode realizes. For example, device embodiment described above is only schematically, for example, and the division of described unit, onlyBe only that a kind of logic function is divided, when actual realization, can have other dividing mode, for example multiple unit or assembly can be tiedClose or can be integrated into another system, or some features can ignore, or not carry out. Another point, shown or discussedCoupling each other or direct-coupling or communication connection can be by some interfaces, the INDIRECT COUPLING of device or unit or logicalLetter connects, and can be electrically, machinery or other form.
The described unit as separating component explanation can or can not be also physically to separate, aobvious as unitThe parts that show can be or can not be also physical locations, can be positioned at a place, or also can be distributed to multipleOn NE. Can select according to the actual needs some or all of unit wherein to realize the order of the present embodiment scheme.
In addition, the each functional unit in each embodiment of the present invention can be integrated in a processing unit, also canBe that the independent physics of unit exists, also can be integrated in a unit two or more unit.
If described function realizes and during as production marketing independently or use using the form of SFU software functional unit, canBe stored in a computer read/write memory medium. Based on such understanding, technical scheme of the present invention in essence in other wordsThe part that prior art is contributed or the part of this technical scheme can embody with the form of software product, this meterCalculation machine software product is stored in a storage medium, comprises that some instructions (can be individual in order to make a computer equipmentPeople's computer, server, or the network equipment etc.) carry out all or part of step of method described in each embodiment of the present invention.And aforesaid storage medium comprises: USB flash disk, portable hard drive, read-only storage (ROM, Read-OnlyMemory), arbitrary access are depositedVarious Jie that can be program code stored such as reservoir (RAM, RandomAccessMemory), magnetic disc, CD or cloud storageMatter.
The above, be only the specific embodiment of the present invention, but protection scope of the present invention is not limited to this, anyBe familiar with those skilled in the art in the technical scope of the present invention's exposure, can expect easily changing or replacing, all should containCover within protection scope of the present invention. Therefore, protection scope of the present invention should described be as the criterion with the protection domain of claim.