Disclosure of Invention
The invention aims to provide an airborne hydrological probe unmanned throwing device and a throwing method, which can be used for carrying a plurality of different hydrological index detection probes according to different hydrological detection requirements, accurately positioning the positions where the probes need to fall, accurately positioning and avoiding the defect that the detected hydrological indexes cannot be used and are invalid due to inaccurate falling of the probes.
In order to achieve the purpose, the invention provides the following technical scheme: an unmanned aerial vehicle hydrology probe throwing device is vertically installed at the bottom of an unmanned aerial vehicle and comprises a throwing device installation frame and a probe cabin;
an electronic control cabin, a first stepping rotating shaft and a second stepping rotating shaft which are positioned on two sides of the electronic control cabin, a gear belt wrapping the first stepping rotating shaft and the second stepping rotating shaft, a probe accommodating space and a probe throwing outlet are arranged in the probe cabin, a plurality of probes are arranged in the probe accommodating space in parallel, and the probes are rotationally connected with the gear belt;
the unmanned releasing device is externally provided with an intelligent camera with a visual navigation sensor, internally provided with a wind speed sensor, a height sensor and a dynamic tilt angle sensor, and the dynamic tilt angle sensor is used for measuring a pitching attitude angle theta and a rolling attitude angle
The tail cover of the probe is hinged with the left side wall of the probe cabin and is connected with the right side wall of the probe cabin through a buckle.
Further, put in device mounting bracket and be central symmetry structure, including first erection angle (1-1), second erection angle, third erection angle and fourth erection angle, the erection angle is the right angle structure, is located every right-angled both sides and respectively is provided with an installation and detains, the installation detain with unmanned vehicles connects.
Further, the installation buckle and the unmanned aerial vehicle are fixedly installed or detachably installed.
The fixed mounting can select screw fastening or direct welding mode, and the detachable mounting can select buckle fixing mode.
Further, the mounting frame is of a centrosymmetric X-shaped structure.
Further, the center of the mounting frame is provided with a central hollow circle, the mounting angle position is provided with a mounting angle hollow circle, and the area ratio of the central hollow circle to the mounting angle hollow circle is (3:1) - (10: 1).
Further, the electronic control cabin is in communication connection with an external control device in a wireless communication mode or a limited communication mode, and receives a throwing signal of the external control device; and a rechargeable battery is arranged in the electronic control cabin.
The invention also provides an unmanned throwing method of the airborne hydrological probe, which comprises the following steps:
s1: filling a plurality of probes in a probe accommodating space of a probe cabin of the airborne hydrological probe unmanned throwing device;
s2: presetting an input task in an electronic control cabin in the probe cabin through an external control device;
s3: the unmanned throwing device acquires image information of a pre-throwing target through an intelligent camera, and the electronic control cabin senses indexes of the environment through a sensor to perform intelligent task watching;
s4: the electronic control cabin receives a task triggering signal and triggers a task;
s5: automatically releasing the probe at the probe releasing outlet in the probe containing space, wherein the probe at the probe releasing outlet is released and falls off;
s6: the probe tail cover is released and discarded, the probe is thrown to a designated place, and the probe throwing task mark is completed;
s7: a first stepping rotating shaft and a second stepping rotating shaft in the probe cabin rotate simultaneously to drive a next probe rotationally connected with a gear of the next probe to enter a probe throwing outlet;
s8: and the next probe is in place, and the electronic control cabin continues to carry out intelligent task watching.
Further, in the step S5, the onboard hydrological probe unmanned releasing device automatically opens the buckle located on the right side wall of the probe cabin to release the probe.
Further, the triggering signal sensed by the electronic control is one of reaching the coordinate position of the throwing place, meeting a preset time period or receiving an external triggering signal.
Further, the method for determining the probe release route in step S5 includes the following steps:
1) determining the position of the probe in the station center coordinate system, and constructing a positioning matrix [ N ] of the station center coordinate system of the probeobj,Eobj,1]TThe formula is as follows:
wherein, G isNEIs a parameter matrix of the intelligent camera, representing the camera pose and position, [ u, v, 1 [ ]]TObtaining normalized uniform pixel coordinates for the camera's visual navigation sensor measurements;
2) calculating a parameter matrix G of the smart camera
NE,
Wherein said
Parameters measured for the visual navigation sensor of a smart camera, said p
camThe r is the central position of the probe expressed by a standing center coordinate system
1Is a first column vector, said r
2For the second column vector, the K is the intrinsic parameter of the camera estimated by the standard camera calibration algorithm, the [ u, v, 1 ]]
TFor normalized uniform pixel coordinates, the [ N ]
obj,E
obj,1]
TIs a positioning matrix of a standing-center coordinate system of the probe, and lambda is a positioning matrix [ N ] of the standing-center coordinate system separating the probe
obj,E
obj,1]
TThe scaling factor required to normalize the homogeneous coordinates;
3) constructing the probe launching route model, and calculating the position (x, y, z) of a launching target geographic coordinate system:
velocity V of the probe relative to air in the inertial system
rThe formula of (1) is:
the vector x is the north position and speed of the standing center coordinate system, the vector y is the east position and speed of the standing center coordinate system, and the vector z is the lower position and speed of the standing center coordinate system; v isxIs the north direction velocity of the drone, vyIs the eastern direction velocity of the drone, vzThe lower direction speed of the unmanned aerial vehicle;
said wxWind speed in the north direction in the inertial system, wyThe inertia is the wind speed in the middle east direction, wzIs the wind speed in the downward direction in the inertial system;
the constant CDThe constant A is the area of the released object, the constant rho is the air density and the constant g is the standard acceleration caused by gravity;
4) constructing navigation path vectors
The formula is as follows:
wherein said V
g=||v
x,v
y,v
z| represents ground speed; said L
1Is the vector
Adjustable length ofThe distance between the intersection point of the expected path of the man-machine and the unmanned aerial vehicle; said η is said vector
And the angle between the velocity vector of the unmanned aerial vehicle;
6) calculating the expected roll angle phi of the navigation pathdThe formula is as follows:
wherein theta is a pitching attitude angle of the unmanned aerial vehicle;
7) calculating a desired tilt angle theta of the navigation pathdThe formula is as follows:
θd=-c1(γ-γd)+γd+αtrim
wherein c is1Is a constant, d is the distance from the position of the unmanned aerial vehicle to the landing point p of the probe, gamma is the flight path angle, gammadTo a desired flight path angle, αtrimIs a correction angle; wherein the content of the first and second substances,
γpis the rotation angle of the unmanned plane around the y axis, KphAnd KihProportional and integral gain of the controller to the tilt angle, respectively, Δ being the distance in front of the probe release point to the probe landing point p, evIs the vertical tracking error;
8) calculating the expected power of the navigation paththrThe formula is as follows:
wherein, the
thrTo the desired power, the
thr,trimTo correct the angle alpha
trimRequired desired power, said
And said
For the controller respectively to the vectors
Velocity V of
aThe proportional gain and the integral gain of (a),
namely the
As vectors
Velocity V of
aDifference V from its desired speed
a,desiredThe expected value of (d); the above-mentioned
Is to make the vertical track error e
vA minimum proportional gain;
9) the automatic pilot of the unmanned aerial vehicle uses the controller to control the power of the side roll, the pitch and the throttle, and provides the estimated wind speed and the position, the speed and the posture of the unmanned aerial vehicle, and the unmanned throwing device calculates the position (x, y, z) of a throwing target geographic coordinate system according to the probe throwing route model for throwing.
Compared with the prior art, the invention has the beneficial effects that:
compare in traditional surface of water measuring platform slow, complicated, expensive, inefficiency, this patent utilizes aerial platform to carry on hydrological probe unmanned on duty, put in, relies on good maneuverability to have obtained unique advantage, and it has higher measurement efficiency, shorter measurement cycle, lower measurement cost, simpler measurement process.
Compared with the inconvenience that similar airborne throwing equipment needs manual operation, the unmanned throwing device for the airborne hydrological probe provided by the invention better solves the problems of intelligent on-duty and automatic throwing.
The unmanned throwing device for the airborne hydrological probe is suitable for aviation platforms, can realize intelligent on-duty and automatic throwing of probes such as ocean temperature and depth, temperature and salinity depth and meteorology, overcomes the complexity of the traditional manual operation mode, reduces the cost of labor resources, and greatly improves the safety of measurement activities.
The unmanned throwing device of the airborne hydrological probe provided by the invention can throw the probe to reach the coordinate position of a throwing place, meet a preset time period or receive an external trigger signal according to a plurality of throwing commands, namely a trigger signal sensed by electronic control, and has sensitivity and wide adaptability.
The method for determining the probe release route can accurately position the position where the probe needs to land, perform accurate positioning, and avoid the defects that the detection hydrological index cannot be used and is invalid due to inaccurate landing of the probe.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
As shown in fig. 1, the unmanned aerial vehicle launching device for the airborne hydrological probe provided by the invention is vertically installed at the bottom of an unmanned aerial vehicle and comprises an installation frame 1 and a probe cabin 2 which are of a launching device and have a centrosymmetric X-shaped structure, as shown in fig. 4, the center of the installation frame 1 is provided with a central hollow circle, an installation angle hollow circle is arranged at an installation angle, and the area ratio of the central hollow circle to the installation angle hollow circle is 5: 1;
as shown in fig. 2-3, an electronic control cabin 2-1, a first stepping rotating shaft 2-2 and a second stepping rotating shaft 2-3 which are positioned at two sides of the electronic control cabin 2-1, a gear belt 2-4 wrapping the first stepping rotating shaft 2-2 and the second stepping rotating shaft, a probe accommodating space 2-5 and a probe releasing outlet 2-6 are arranged in the probe accommodating space 2-5, a plurality of probes 2-7 are arranged in parallel in the probe accommodating space 2-5, and the probes 2-7 are rotatably connected with the gear belt 2-4;
the unmanned throwing device is externally provided with an intelligent camera with a visual navigation sensor, internally provided with a wind speed sensor, a height sensor and a dynamic tilt angle sensor, wherein the dynamic tilt angle sensor is used for measuring a pitching attitude angle theta and a rolling attitude angle
The tail cover 2-61 of the probe 2-6 is hinged with the left side wall 2-8 of the probe cabin and is connected with the right side wall 2-9 of the probe cabin through a buckle 2-10.
As shown in fig. 4, the launching device mounting frame 1 is of a central symmetry structure and comprises a first mounting angle 1-1, a second mounting angle 1-2, a third mounting angle 1-3 and a fourth mounting angle 1-4, the mounting angles are of a right-angle structure, two mounting buckles 1-5 are arranged on two sides of each right angle respectively, and the mounting buckles are connected with the unmanned aerial vehicle. The mounting buckle is fixedly mounted with the unmanned aerial vehicle or detachably mounted; the fixed mounting mode can be screw fastening or direct welding, and the detachable mounting mode can be fastening.
The electronic control cabin 2-1 is in communication connection with an external control device through a wireless communication mode or a limited communication mode and receives a throwing signal of the external control device; a rechargeable battery is arranged in the electronic control cabin 2-1.
As shown in fig. 6, the unmanned aerial vehicle launching method for the airborne hydrological probe provided by the invention comprises the following steps:
s1: filling a plurality of probes in a probe accommodating space of a probe cabin of the airborne hydrological probe unmanned throwing device;
s2: presetting an input task in an electronic control cabin in the probe cabin through an external control device;
s3: the unmanned throwing device acquires image information of a pre-throwing target through an intelligent camera, and the electronic control cabin senses indexes of the environment through a sensor to perform intelligent task watching;
s4: the electronic control cabin receives a task triggering signal and triggers a task;
s5: the probe at the probe throwing-in outlet in the probe containing space is automatically released, and the probe at the probe throwing-in outlet is released and falls off;
as shown in fig. 5, after receiving a trigger task, the probe automatically releases the connection with the right side wall 2-9 through the buckle 2-10, and releases from the position 1 in the cabin, at the moment, the probe still keeps hinged connection with the left side wall 2-8, gradually moves from the position 1 to the position 2 due to gravity, finally moves to the position 3, keeps the same direction vertical to the ground with the throwing outlet 2-6, at the moment, the probe is separated from the right side wall 2-8, and finally vertically falls freely, and is released at a designated position;
s6: releasing and discarding the tail cover of the probe, putting the probe to a specified place, and marking the putting task of the probe to be finished;
s7: a first stepping rotating shaft and a second stepping rotating shaft in the probe cabin rotate simultaneously to drive a next probe rotationally connected with a gear of the next probe to enter a probe throwing outlet;
s8: the next probe is in place, and the electronic control cabin continues to carry out intelligent task on duty.
And in the step S5, the onboard hydrological probe unmanned releasing device automatically opens the buckle positioned on the right side wall of the probe cabin to release the probe.
The triggering signal sensed by the electronic control is one of reaching the coordinate position of the throwing place, meeting a preset time period or receiving an external triggering signal.
As shown in fig. 7, the method for determining the probe release route in the step S5 includes the steps of:
1) determining the position of the probe in the station center coordinate system, and constructing a positioning matrix [ N ] of the station center coordinate system of the probeobj,Eobj,1]TThe formula is as follows:
wherein G isNEIs a parameter matrix of the intelligent camera, representing the camera pose and position, [ u, v, 1 [ ]]TObtaining normalized uniform pixel coordinates for the camera's visual navigation sensor measurements;
2) calculating parameter matrix G of intelligent camera
NE,
Parameters measured for the visual navigation sensor of a smart camera, p
camThe center position of the probe expressed by a standing center coordinate system, r
1Is a first column vector, r
2For the second column vector, K is the intrinsic parameter of the camera estimated by the standard camera calibration algorithm, [ u, v, 1 [ ]]
TFor normalized uniform pixel coordinates, [ N ]
obj,E
obj,1]
TIs a positioning matrix of a standing-center coordinate system of the probe, and lambda is a positioning matrix [ N ] of the standing-center coordinate system of the separated probe
obj,E
obj,1]
TThe scaling factor required to normalize the homogeneous coordinates;
by setting a first column vector quantity r1And a second column vector r2Forming a parameter matrix G of the smart cameraNEK is the intrinsic parameters of the camera estimated by the standard camera calibration algorithm, by multiplying by the parameters of the smart cameraMatrix GNECamera intrinsic parameter K, normalized uniform pixel coordinates u, v, 1]TConversion from image coordinates to camera coordinates to a positioning matrix [ N ] belonging to the centroid coordinate systemobj,Eobj,1]Tλ is the positioning matrix [ N ] of the station center coordinate system where the probe is locatedobj,Eobj,1]TThe scaling factor required to normalize the homogeneous coordinates;
3) constructing a probe launching route model, and calculating the position (x, y, z) of a launching target geographic coordinate system:
velocity V of probe relative to air in inertial system
rThe formula of (1) is:
wherein, the vector x is the north position and speed of the standing center coordinate system, the vector y is the east position and speed of the standing center coordinate system, and the vector z is the lower position and speed of the standing center coordinate system; v. ofxIs the north direction speed, v, of the droneyIs the east direction velocity, v, of the dronezThe lower direction speed of the unmanned aerial vehicle;
wxwind speed in the north direction in the inertial system, wyThe inertia system is the wind speed in the middle east direction, wzIs the wind speed in the downward direction in the inertial system;
constant CDThe constant A is the area of the released object, the constant rho is the air density and the constant g is the standard acceleration caused by gravity;
4) constructing navigation path vectors
The navigation module will guide the drone to fly upwind along the reference line while remaining at the same timeConstant, stable height. Since the release point depends on the direction of the release velocity vector, this pair of vectors must construct a navigation path
The probe path determination method provided by the invention uses a line-of-sight guidance law, which not only determines the final destination of flight, but also determines the route along which the unmanned aerial vehicle will fly towards the destination, rather than performing simple path pursuit towards the release point, and the navigation path vector
The formula is as follows:
wherein V
g=||v
x,v
y,v
z| represents ground speed; l is
1As vectors
The adjustable length is the distance between the intersection point of the unmanned aerial vehicle and the expected path of the unmanned aerial vehicle; eta is a vector
And the angle between the velocity vector of the unmanned aerial vehicle;
6) calculating the expected roll angle phi of the navigation pathdThe formula is as follows:
wherein theta is a pitching attitude angle of the unmanned aerial vehicle;
due to the sensitivity of the drop position to lateral movement of the drone, the length d near the release point is large enough to make the roll attitude angle
And the transient state of the cross track error can be ignored;
7) calculating a desired tilt angle theta of the navigation pathdThe formula is as follows:
θd=-c1(γ-γd)+γd+αtrim
wherein c is1Is constant, d is the distance from the position of the unmanned aerial vehicle to the probe landing point p, gamma is the flight path angle, gammadTo a desired flight path angle, αtrimIs a correction angle; wherein the content of the first and second substances,
γpis the rotation angle of the unmanned plane around the y axis, KphAnd KihProportional and integral gain of the controller to the tilt angle, respectively, Δ being the distance in front of the probe release point to the probe landing point p, evIs the vertical tracking error;
8) calculating the expected power of the navigation paththrThe formula is as follows:
wherein the content of the first and second substances,
thrin order to obtain the desired power,
thr,trimto correct the angle alpha
trimThe required desired power is that which,
and
are respectively controller pair vector
Velocity V of
aThe proportional gain and the integral gain of (a),
namely, it is
As vectors
Velocity V of
aDifference V from its desired speed
a,desiredThe expected value of (d);
is to make the vertical track error e
vA minimum proportional gain;
9) the automatic pilot of the unmanned aerial vehicle uses the controller to control the power of the side roll, the pitch and the throttle, and provides the estimated wind speed and the position, the speed and the posture of the unmanned aerial vehicle, and the unmanned throwing device calculates the position (x, y, z) of a throwing target geographic coordinate system according to the probe throwing route model for throwing.
This application carries on unmanned aerial vehicle who puts in device of probe and keeps invariable height and speed.
Further, the area ratio of the installation angle hollowed-out circle to the installation angle hollowed-out circle at the center of the installation rack 1 is 3: 1.
Further, the area ratio of the installation angle hollowed-out circle to the installation angle hollowed-out circle at the center of the installation frame 1 is 10: 1.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. It will be readily apparent to those skilled in the art that various modifications to these embodiments and the generic principles defined herein may be applied to other embodiments without the use of the inventive faculty. Therefore, the present invention is not limited to the above-described embodiments. Those skilled in the art should appreciate that many modifications and variations are possible in light of the above teaching without departing from the scope of the invention.