CN204314726U - A kind of six rotor unmanned helicopters follow the tracks of flight control system - Google Patents
A kind of six rotor unmanned helicopters follow the tracks of flight control system Download PDFInfo
- Publication number
- CN204314726U CN204314726U CN201420788112.3U CN201420788112U CN204314726U CN 204314726 U CN204314726 U CN 204314726U CN 201420788112 U CN201420788112 U CN 201420788112U CN 204314726 U CN204314726 U CN 204314726U
- Authority
- CN
- China
- Prior art keywords
- control
- rotor unmanned
- flight
- processing unit
- flight control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 title claims abstract description 50
- 230000005540 biological transmission Effects 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims abstract description 8
- 238000012545 processing Methods 0.000 claims description 42
- 230000007246 mechanism Effects 0.000 claims description 27
- 238000004891 communication Methods 0.000 claims description 10
- 230000005611 electricity Effects 0.000 claims description 5
- 238000000034 method Methods 0.000 abstract description 20
- 230000008569 process Effects 0.000 description 11
- 230000008859 change Effects 0.000 description 10
- 230000006870 function Effects 0.000 description 8
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 7
- 229910052744 lithium Inorganic materials 0.000 description 7
- 238000013461 design Methods 0.000 description 6
- 238000006073 displacement reaction Methods 0.000 description 6
- 230000004888 barrier function Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 4
- 238000007667 floating Methods 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 238000012913 prioritisation Methods 0.000 description 3
- 230000000630 rising effect Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000002547 anomalous effect Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009977 dual effect Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 229920000049 Carbon (fiber) Polymers 0.000 description 1
- 241000218645 Cedrus Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 206010034719 Personality change Diseases 0.000 description 1
- 230000003416 augmentation Effects 0.000 description 1
- 239000004917 carbon fiber Substances 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000003412 degenerative effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- VNWKTOKETHGBQD-UHFFFAOYSA-N methane Chemical compound C VNWKTOKETHGBQD-UHFFFAOYSA-N 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 238000013439 planning Methods 0.000 description 1
- 230000009993 protective function Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000003756 stirring Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The utility model discloses a kind of six rotor unmanned helicopters and follow the tracks of flight control system, six rotor unmanned helicopters are followed the tracks of flight control system and are comprised airborne portion, ground station control part, described airborne portion comprises six rotor flying platform and flight controllers, and described ground station control part comprises the detection and control terminal with wireless transmission function; Native system comprises control and Non-follow control two kinds of patterns automatically; This system has the feature of small in volume.The invention also discloses a kind of control method of six rotor unmanned helicopter flight control systems, calculate control output quantity by closed loop control algorithm and control topworks's work; The method achieve the tracking of six rotor unmanned helicopters in indoor to fly, extend the range of application of many rotor unmanned helicopters.The utility model has good economic results in society.
Description
Technical field
The utility model relates to the autonomous flight control technical field of telecontrolled model multirotor helicopter, particularly relates to a kind of six rotor unmanned helicopters and follows the tracks of flight control system.
Background technology
Six rotor unmanned helicopters be a kind of structure simple, be easy to manipulate, can the stable unmanned vehicle of vertical takeoff and landing, floating state.It has 6 to be symmetrically distributed in the paired rotor of body surrounding, rotating, by changing each gyroplane rotate speed to realize the control to six-freedom degree, generally adopts electrical energy drive.Six rotor unmanned helicopters have high controllability, maneuverability and stability, and have the features such as low noise, pollution-free, easy to carry, safety hazard is little, are very suitable for the aerial mission performing short-distance and medium-distance.It all has broad application prospects in military and civilian field, as reconnaissance and surveillance, communication relaying, searching rescue, target following, electric power overhaul, imaging etc. of taking photo by plane.
The mode of navigate mode many employings INS/GPS integrated navigation of current many rotor unmanned helicopters.This causes many rotor unmanned helicopters only in the place that outdoor gps signal is stronger, independently can complete aerial mission, thus greatly limit the range of application of many rotor unmanned helicopters.
Therefore, solve the problem in the urgent need to.
Utility model content
Technical problem to be solved in the utility model is for defect involved in background technology, propose a kind of six rotor unmanned helicopters and follow the tracks of flight control system, controlling in indoor or without tracking flight during gps signal for solving six rotor unmanned helicopters, extending the range of application of many rotor unmanned helicopters.
The utility model, for solving the problems of the technologies described above, adopts following technical scheme:
A kind of six rotor unmanned helicopters follow the tracks of flight control system, comprise airborne portion and ground station control part, wherein, described airborne portion comprises six rotor flying platform and flight controllers, and described ground station control part comprises the detection and control terminal with wireless transmission function;
Described six rotor flying platforms comprise six groups of aviation mechanisms, frame and brushless The Cloud Terrace, and described six groups of aviation mechanisms are symmetrically located at six end points of frame, and described brushless The Cloud Terrace is fixed immediately below described frame;
Described aviation mechanism comprises electric mechanical, electrical mediation screw propeller, and described motor is used for carrying screws and rotates, and described electricity calls the rotating speed in adjustment motor;
Described flight controller comprises flight control modules, sensor assembly, vision guided navigation module, wireless transport module, power module and remote-control receiver;
Described flight control modules comprises main control unit and association's processing unit;
Described sensor assembly comprises six axle attitude sensors, electronic compass, ultrasonic height meter, radar sensor;
Described vision guided navigation module comprises camera and graphics processing unit, and described camera is arranged on brushless The Cloud Terrace;
Described main control unit respectively with six groups of aviation mechanisms, six axle attitude sensors, ultrasonic height meter, assist processing unit, graphics processing unit is electrically connected, described graphics processing unit is electrically connected with radar sensor, camera respectively; Described association processing unit and wireless data transmission module are electrically connected;
Described detection and control terminal and described wireless data transmission module carry out data communication by wireless.
The further prioritization scheme of flight control system is followed the tracks of as a kind of six rotor unmanned helicopters of the utility model, described power module comprises three pieces of batteries, is respectively six groups of aviation mechanisms of six rotor unmanned helicopters, flight control modules and vision guided navigation module and provides power supply.
Follow the tracks of the further prioritization scheme of flight control system as a kind of six rotor unmanned helicopters of the utility model, described main control unit adopts ATMEGA2560 single-chip microcomputer, and described association processing unit adopts ATMEGA32U2 single-chip microcomputer.
The further prioritization scheme of flight control system is followed the tracks of as a kind of six rotor unmanned helicopters of the utility model, described six axle attitude sensors adopt MPU-6000 six axle attitude sensor, described ultrasonic sensor adopts LV-MaxSonar-EZ1 sonic sensor, and described radar sensor adopts UTM-30LX signal laser scanning rangefinder.
The utility model adopts above technical scheme compared with prior art, has following technique effect:
Adopt the hardware circuit that dual processor flight control system combines with vision navigation system, all data handling procedures are all by completing by airborne equipment, completely avoid the flight failure that the reasons such as factor data transmission delay or communication signal be unstable cause, the flight effect of this six rotor unmanned helicopter is goodly stablized, has more practicality.
Accompanying drawing explanation
Fig. 1 is the utility model flight control system hardware block diagram;
Fig. 2 is the utility model software control FB(flow block);
Fig. 3 is the utility model six rotor unmanned helicopter horizontal direction control system block diagram;
Fig. 4 is that the utility model six rotor unmanned helicopter attitude ring expects roll angle and actual roll angle curve of output;
Fig. 5 is the utility model target following relative distance X-axis graph of errors.
Embodiment
Below in conjunction with accompanying drawing, the technical solution of the utility model is described in further detail:
This six rotor unmanned helicopter follows the tracks of flight control system, comprises airborne portion and ground station control part.Described airborne portion comprises six rotor flying platforms, flight controller; Wherein, six described rotor flying platforms comprise symmetrical frame and aviation mechanism, and described flight controller comprises flight control modules, sensor assembly, vision guided navigation module, wireless transport module, power module and remote-control receiver.In flight controller, described flight control modules comprises two pieces of single-chip microcomputers and a block storage, and two pieces of single-chip microcomputers are respectively as main control unit and association's processing unit; Described sensor assembly comprises six axle attitude sensors, electronic compass, ultrasonic height meter, radar sensor; Described vision guided navigation module comprises camera, brushless The Cloud Terrace and graphics processing unit; Described power module comprises three pieces of batteries, is respectively the flying power of six rotor unmanned helicopters, flight control modules and vision guided navigation module and provides power supply.Described ground station control part comprises the detection and control terminal with wireless transmission function; Wherein, described observing and controlling middle-end comprises PC control desk and telepilot.
This six rotor unmanned helicopters rack construction is X-type, and its flight path and flight attitude realize by the rotation of six rotors and motor: when the rotating speed of six rotors increases (reductions) simultaneously, aircraft level rising (decline); When two, front side gyroplane rotate speed is greater than (being less than) rear side two gyroplane rotate speeds, aircraft layback (front bow), (front) flies backward; When three, left side gyroplane rotate speed is greater than three gyroplane rotate speeds in (being less than) right side, aircraft is (left side) deflection to the right.
Below by six rotor unmanned helicopters referred to as unmanned plane.
In UAS, flight control system is as " nerve center " of unmanned plane, take flight control modules as control core, auxiliary phase induction sensor module, aviation mechanism, servocontrol module, wireless transport module, detection and control terminal etc., realize the function such as the independent navigation to unmanned plane, flight control, task management.
UAV Flight Control System mainly comprises inner looping and external loop two loops, and wherein inner looping is flight control loop, i.e. attitude ring, realizes the accurate control to UAV Attitude; External loop is navigational guidance loop, i.e. position ring, realizes the accurate tracking of pair warp and weft, height, thus realizes the autonomous tracking of unmanned plane to target.Control system of the present utility model is mainly a set of realizes unmanned plane independently completes aerial mission software and hardware platform in indoor.Flight control modules receives the information that various kinds of sensors gathers, compare to corresponding " command signal " that flight control system loop provides and the error obtained, respectively as the input of guidance algorithm and control law algorithm, complete guidance and the resolving of control law, the calculation result of guidance algorithm is also as the instruction of control module.Aviation mechanism then resolves the rotation speed change of the corresponding rotor motor of the order-driven drawn according to control module, thus realizes the control to unmanned plane.
As shown in Figure 1, this six rotor unmanned helicopter follows the tracks of flight control system, comprises airborne portion and ground station control part.The two kinds of modes that communicated of airborne portion and land station, namely the FUTABA telepilot radio communication of 2.4GHz communicates with 433MHz wireless transport module.FUTABA telepilot is the general telepilot of a model plane that Japanese Futaba Denshi Kogyo Kabushiki Kaisha produces, and supports the use with this brand receiver.Model plane operator can by stirring some driving levers on telepilot, and the diverse location residing for each driving lever corresponds to different strokes, can produce each passage remote control pwm signal with distinct pulse widths.Wireless data transmission module transmission frequency is 433MHz, and maximum transmission distance is 700m, is divided into two modules, is that Air module (serial ports) is carried for aircraft respectively, and Ground module (USB interface) connects computer for ground and uses.
Airborne portion of the present utility model comprises flight control modules, sensor assembly and interface circuit thereof, vision guided navigation module and interface circuit, wireless transport module and interface circuit thereof, power module, remote-control receiver, aviation mechanism etc.Six groups of rotors and motor are positioned at six end points of frame, are connected with the main control unit in flight control modules by PWM output driving circuit; Six axle attitude sensors are connected with main control unit by spi bus level conversion; Ultrasonic height meter is connected with main control unit by Transistor-Transistor Logic level interface; Graphics processing unit is connected with main control unit by UART serial ports; Radar sensor is connected with graphics processing unit by Transistor-Transistor Logic level interface; Camera turns Transistor-Transistor Logic level interface by USB and is connected with graphics processing unit; Wireless data transmission module is connected with assisting processing unit by UART serial ports; The terrestrial wireless digital transmission module of ground station control part and the wireless data transmission module of airborne portion carry out data communication.
Flight control modules of the present utility model is the Duo-Core Architecture system be made up of two pieces of 8 processor of single chip computer, and main control unit is ATMEGA2560, and association's processing unit is ATMEGA32U2.
ATMEGA2560 processor and ATMEGA32U2 processor are 8 16MHz single-chip microcomputers that American ATMEL is produced.Wherein main control unit ATMEGA2560 has 54 railway digital I/O (wherein 16 tunnels can be used as PWM output), 16 road ADC, 4 road UART and SPI, I2C interface.It can be used as the main control unit of flight control system, its core frequency and peripheral hardware resource can be made full use of, be mainly used to process sensor data and send six passage PWM information to aviation mechanism.ATMEGA2560 is the processor supported of Arduino development platform simultaneously, and the interface function that calling Arduino platform provides can develop research efficiently.Association processing unit ATMEGA32U2 is compared with main control unit, and peripheral hardware resource is less, is therefore only used as catching and PPM scrambler of PWM information, is transferred to main control unit ATMEGA2560 again after catching the pwm signal that receiver sends.Below flight control modules is described in detail:
In flight control modules, ATMEGA2560 is main control unit, integrates and flies control, navigation feature; ATMEGA32U2 is association's processing unit, and primary responsibility and ground station control part are carried out alternately, processing instruction.The utility model adopts Duo-Core Architecture, between the two by SCI serial communication.Though serial communication speed is fast not as good as parallel port RAM, consider in the flight control system of this programme, with the rate transmissioning data of the kbp/s order of magnitude, energy completion system is to the basic demand of real-time.
Main control unit ATMEGA2560 mainly completes: collecting sensor signal process, industrial control board information processing, motor drive, with assist that processing unit communicates, control law resolves, navigation algorithm (flight course planning) and fault detect etc.Association processing unit ATMEGA32U2 mainly completes: communicate with land station, remote information receives, communicates with main control unit, this scheme is fully by maximum resource utilization.
Main control unit ATMEGA2560 is control core, and all work completed constitutes the closed-loop control of band feedback.Its processes sensor information, for flight control system provides feed back input; Process steering order manually or automatically, adopt different control modes according to concrete instruction; Drive motor action.On this basis, keep away barrier information according to vision guided navigation, radar independently to complete and to find tracked mobile target.Dual core processor demonstrates the advantages such as perfect in shape and function, speed is fast, exploitation is convenient with powerful order set and interface function, effectively can solve at a high speed and miniature contradiction, thus integrate the novel flight control modules of high speed, high precision and miniaturization for the design of unmanned plane amount body.
Association processing unit ATMEGA32U2 serves the effect of " information transfer bridge " between ground station control part and main control unit ATMEGA2560, UAV Attitude and positional information go downwards to land station through association's processing unit from main control unit, and the instruction of ground station control part is up to main control unit through association's processing unit.High speed SCI communication (57600bps maximum baud rate) can guarantee that communication is simple and reliable.
The sensing system used in the utility model comprises:
Six axle attitude sensors: the MPU-6000 six axle attitude sensor selecting American I nvensense company to produce, it incorporates 3 axle gyroscopes, 3 axle accelerators, is the whole world the first conformability 6 axle motion process assembly.MPU-6000 exports the fusion calculation data of the rotation matrix of 6 axles or 9 axles, hypercomplex number, Eulerian angle form with numeral.Compared to multicompartment scheme, MPU-6000 eliminates the problem of between centers difference when combining gyroscope and accelerator, decreases a large amount of packaging spaces, has low-power consumption, low cost, high performance feature.
The sensing range of angular velocity is ± 250 °, ± 500 °, ± 1000 ° and ± 2000 °/sec (dsp), can accurately follow the trail of fast and action at a slow speed; The sensing range of programmable accelerometer is ± 2g, ± 4g, ± 8g and ± 16g simultaneously.The measurement data of sensor finally exports by the IC bus of the highest 400kHz or the spi bus of the highest 20MHz.
Ultrasonic sensor: select the LV-MaxSonar-EZ1 sonic sensor that Pololu company of the U.S. produces.This ultrasonic distance measuring module has low in energy consumption, that precision is high, detection range is far away feature, and its sensing range is 0 to 6.45M (21.2ft), resolution 2.5cm, non-blind area.This sensor provides three output interfaces: the output of digit duration, analog signal output, and asynchronous serial exports, and uses more convenient.
Laser radar sensor: select the UTM-30LX signal laser scanning rangefinder that Japanese HOKUYO company produces.This laser scanning and ranging instrument measuring distance is 30m (resolution is 1mm), and take measurement of an angle 270 ° (resolution is 0.25 °), its low-profile, measures accurately, is aly perfect to be applied to the radar sensor that unmanned plane keeps away barrier.This laser scanning and ranging instrument power consumption is only 12V700mA, can be applicable to battery powered platform.
The hardware of vision guided navigation part mainly comprises:
Camera: this utility model selects USB camera, hardware pixel is 100W720p, and angle is 170 °, and frame rate is 30fps/1280 × 720, and the storage format after Dynamical capture is AVI/WMV.The resolution of this camera can take into account image definition and image processing speed.
Brushless The Cloud Terrace: this utility model selects the brushless The Cloud Terrace of Gopro diaxon, its built-in two 32 high speed ARM core processors, three rotor MEMS gyro instrument and three rotor mems accelerometers.Control accuracy can reach 0.1 °.Control angle scope, pitch orientation be-135 ° ~ 90 °, roll direction is-45 ° ~ 45 °.This is brushless, and The Cloud Terrace ensure that camera all the time vertically downward, stablizes and follows seizure moving target, and by the impact of UAV Attitude change.
Graphics processing unit: this utility model selects CPU to be that the industrial control board of Intel Cedar view-M N2600 is used as pattern process computer.This graphics processing unit has 4 I/O ports, 2 com ports, supports the input of+12V DC direct current or 2S2P lithium battery power supply, supports WinXP, Win 7 and (SuSE) Linux OS.It has the advantages that quality is light, volume is little, processing speed is fast.Use this graphics processing unit Video processing to be completed on airborne hardware, ensure that the real-time of image information.
Wireless data transmission module is that its range of control determines the flying radius of unmanned plane for Long-distance Control unmanned plane one method in this utility model.Wireless data transmission module passes mutually for the data between the land station that realizes being positioned at ground and the flight control system being positioned at aerial UAV flight.3DR Radio Telemetry digital transmission module is selected in this design, and transmission frequency is 433MHz, and maximum transmission distance is 700m, uses UART interface to export data.
The utility model flight control use three pieces independently lithium battery is powered, use the flying power that the lithium battery of 10000mAh, 25C, 22.2V is unmanned plane to power respectively, the lithium battery of 900mAh, 15C, 7.4V is that flight control modules is powered and the lithium battery vision guided navigation module for power supply of 2200mAh, 25C, 11.1V.Wherein, the power supply of flight control modules need carry out step-down, provides these two kinds of direct supplys of 5V, 3.3V to meet the demand of main control chip.The UBEC-3A using Shenzhen Hao Ying scientific & technical corporation to produce realizes the high step-down of 7.4V → 5V, and 5V is as the VCC of digital circuit.UBEC is a kind of DC voltage-stabilizing system of Switching Power Supply mode, is operated in the switching frequency of 300KHz, and chip efficiency up to 92%, and provides overcurrent and overheat protective function.The MIC5219-3.3 using MICREL company of the U.S. to produce realizes the low pressure drop of 5V → 3.3V, and can reach very high efficiency, and cost is low, noise is low, and quiescent current is little, and circuit structure is simple.
The power device of multi-rotor aerocraft comprises brushless electric machine, electricity tune, screw propeller and electrical source of power, and wherein electric mechanical, electrical mediation screw propeller is referred to as aviation mechanism again.Power device determines maximum load ability, cruising time and the maneuverability of many rotors.The design of this utility model adopts the brushless electric machine of T-motor 4014 model, the carbon fiber spiral oar of collocation 10000mAh 25C 22.2V lithium battery and 1445 models.This brushless electric machine arrange in pairs or groups 1445 type screw propellers and 22.2V lithium battery time, 100% throttle place corresponding current is 29.9A, thus electricity tune make good use of be full of company produce 30A electricity adjust.Based on above power device type selecting, this unmanned plane lifting capacity >=5.8kg, cruising time >=15min.
The functional requirement controlled according to flight and system hardware structure feature adopt modularization programming, application program is divided into several relatively independent program modules, completes corresponding function respectively.Software development often adopt the most basic, without the straight line program design of operating system, to be that the code that generates is short and small simplify its advantage, and travelling speed is fast, and this programme fault-tolerance is strong, reliability is high and it is simple to safeguard.
Fig. 2 is that system realizes the autonomous overall flow figure followed the tracks of.The software simulating of airborne portion mainly comprises 5 functional modules: (1) sensor data acquisition module; (2) data resolve module; (3) augmentation control module; (4) aviation mechanism functional module; (5) wireless data transmission module.The software section of ground control station mainly comprises 2 functional modules: (1) terrestrial wireless digital transmission module; (2) posture position information display module.In fig. 2, be the control flow of the software of airborne portion in the square frame of right half part, its performance period is 10ms, completes digital independent, data are resolved, calculates PID output quantity, arranges the tasks such as PWM output.
The control model of described six rotor unmanned helicopter flight control systems comprises MANUAL CONTROL mode and automatic control mode.
MANUAL CONTROL mode control flow is as follows:
Remote-control receiver receives remote controller signal and transfers to association's processing unit, and association's processing unit is to timed sending after the signal transacting received to main control unit, and described main control unit controls aviation mechanism work to exporting to respectively after the signal transacting received.
After being provided with tracking target to mobile object, the automatic control mode control flow of six rotor unmanned helicopters is as follows:
1. the picture of described camera Real-time Collection tracking target, and described picture is sent to graphics processing unit;
2. described radar sensor gathers relative position, the speed data of six rotor unmanned helicopters and indoor barrier, and described data are sent to graphics processing unit;
3. graphics processing unit will calculate the relative position of six rotor unmanned helicopters and tracking target according to the picture that receives, and by the relative position of itself and six rotor unmanned helicopters that receive and indoor barrier, speed data timed sending to main control unit;
4. described six axle attitude sensors and ultrasonic height are scored other Real-time Collection six rotor unmanned helicopter attitude, altitude information, and the data collected are sent to described main control unit;
5. main control unit calculates the motor output quantity of six aviation mechanisms according to the data received, and exports six aviation mechanisms respectively to, controls aviation mechanism work;
6. the real time data information of main control unit carries out reaching ground station control part under after process in the future, shows six rotor unmanned helicopter real-time flight data at PC control desk.
A under-actuated systems and unmanageable feature for six rotor unmanned helicopters, " control law resolves " this link in Fig. 2, adopt classical PID controller to control six heligyroes, technical scheme is as follows:
(1) control six rotor unmanned helicopters independently to take off, fly before completing and two actions of rising simultaneously, and the attitude data of six rotor unmanned helicopters, relative velocity data and altitude information in Real-time Feedback uphill process, when helicopter rises to the height preset, stop rising, now six rotor unmanned helicopters are in floating state;
(2) do not detect when following the trail of the objective, six rotor unmanned helicopters keep floating states, attitude data, altitude information, the relative velocity data of sensor assembly Real-time Collection helicopter, and the data collected are sent to main control unit; Described PC control desk sends data to association's processing unit by wireless transport module; Described association processing unit real-time reception sensing data and PC control desk data, process data into the form timed sending of " frame " to main control unit; The Frame received is calculated attitude data, altitude information, relative velocity data by described main control unit, homogeneous data under the data calculated and floating state is compared, according to the error information obtained, and the controlled quentity controlled variable of aviation mechanism is calculated according to control law, described control law adopts following formula to represent:
wherein, Δ δ is the controlled quentity controlled variable of aviation mechanism, and Δ e is error information, and Δ e' is error information rate of change, k
pfor the coefficient of error information, k
ifor the coefficient of error information integration, k
dfor the coefficient of error information rate of change, p is that ratio controls, and i is integration control, and d is that differential controls.
(3) detect that when following the trail of the objective, except method described in (2), vision guided navigation module acquisition tracking target, determines relative position information, and the data collected are sent to main control unit; The Frame received is calculated station-keeping data by described main control unit, namely obtains tracking error data, and calculates the controlled quentity controlled variable of aviation mechanism according to control law, and described control law adopts following formula to represent:
Described control law resolves attitude retentive control rule, height retentive control rule, the horizontal direction Position Tracking Control rule of module, and described method is as follows:
A. attitude retentive control rule
The control law of unmanned plane three axis attitude keeping system is all fed back by attitude angular rate and angular displacement and forms, and improves the stability of helicopter by this electrical feedback mode.Concerning vertical/horizontal gesture stability and Heading control, attitude keeping system is equivalent to classical PID and controls.Attitude keeping system is in innermost ring, all needs to connect in whole flight course.
Attitude keeps the attitude angle reference value in loop to refer to the trim value of aircraft under hovering mode, and obtain by experiment, usually differing is decided to be zero; The actual measured value of attitude is recorded by airborne sensor.The difference of actual value and reference value is error, the source that Here it is " Error Feedback control "; Loop is kept for attitude, attitude angular velocity and attitude angle displacement two errors can be obtained.
The attitude retentive control rule of six rotor unmanned helicopter pitch channels is:
The attitude retentive control rule of six rotor unmanned helicopter roll passages is:
Wherein, Δ δ
e, Δ δ
abe respectively the controlled quentity controlled variable in pitching, roll direction, Δ e
θwith
the error of angle of pitch error and rate of pitch respectively, Δ e
φwith
the error of roll angle error and roll angle speed respectively,
with
be the coefficient of angle of pitch displacement, angle of pitch displacement anomalous integral pitch rate,
with
be the coefficient of roll angle displacement, roll angle displacement anomalous integral rolling angle rate.
Restrain for the attitude retentive control of pitch channel,
with
constitute a kind of PID control law.Δ δ
ebe converted into the pwm signal of corresponding ratio, act on aviation mechanism.When unmanned plane is bowed, corresponding control law can make two, front motor speed increase generation nose-up pitching moment, allows unmanned plane come back, and to offset the trend of bowing, make unmanned plane keep balance, vice versa.
with
the acquisition of three parameters takes the scheme of " first according to modelling, test adjustment again " to debug out, and object makes the fast response time of unmanned plane, overshoot little.In Fig. 4, two curves are respectively the actual angle of pitch after adding attitude retentive control rule and expect attitude angle curve over time.As shown in Figure 4, after adding above-mentioned attitude retentive control rule, the actual angle of pitch can stablize the change of following and expecting the angle of pitch, and meets the little requirement of good stability, fast response time, overshoot.
Experiment proves, this control program is simple, Be very effective, the ability of the anti-interference in air flow that unmanned plane is possessed is certain.
B. height retentive control rule
Change the method for height, namely change motor speed, thus improve lift.Altitude control be in fact exactly the true altitude fed back by height sensor compared with setting height, adjust the size of motor speed according to deviate.Altitude control is in fact also that a classical PID controls.
It is fixed high that hovering mode needs, and at this moment a given fixing height value is as setting value, now namely forms and highly keeps mode.When practical flight, usually write down and switch to height value when automatically controlling as high hold reference value by Non-follow control, the height of take-off and landing process can be the command signal on class slope.
Under hovering mode, high hold control law is:
Wherein, Δ e
hwith
the error of height error and altitude rate,
with
be controling parameters, constitute PID control law.The output Δ δ of control law
cbe superimposed upon on six motors, like this, when unmanned plane falls height, motor speed can strengthen, lift-rising; When unmanned plane height exceedes preset value, motor speed reduces, and produces a kind of degenerative automatic control effect.The scheme that these three controling parameters also adopt " first according to modelling, test adjustment again " debugs out.
C. horizontal direction Position Tracking Control rule
Position control and unmanned plane TRAJECTORY CONTROL.TRAJECTORY CONTROL mainly constantly revises the position of unmanned plane to ensure that the stable moving target of following of unmanned plane flies by the positional information of vision guided navigation module feedback.As shown in Figure 3, pitch channel and roll channel control position deviation and P to control rate information to feed back to inner looping respectively by PID.
The tracing control rule of six rotor unmanned helicopters in horizontal x direction is:
The tracing control rule of six rotor unmanned helicopters in horizontal y direction is:
Wherein, Δ δ
θ, Δ δ
φbe respectively x, y direction controlling amount, u, v are respectively the speed data in x, y direction, Δ e
x, Δ e
x' be the error in x-axis direction and error change rule, Δ e
y, Δ e
y' be the error in y-axis direction and error change rule,
with
the controling parameters in x-axis direction,
with
it is the controling parameters in y-axis direction.
For the tracing control rule of six rotor unmanned helicopters in horizontal x direction,
with
form PID control law.The output Δ δ of control law
θas the input of pitch channel inner looping.Like this, when unmanned plane is positioned at moving target rear, the angle of pitch expected is on the occasion of increase, acts on inner looping and strengthens unmanned plane forward flight speed; Otherwise when unmanned plane is positioned at moving target front, the angle of pitch expected is that negative value increases, and acts on inner looping and reduces unmanned plane forward flight speed.The scheme that these four controling parameters also adopt " first according to modelling, test adjustment again " debugs out.Curve in Fig. 5 is after adding above-mentioned horizontal direction Position Tracking Control rule, the relative distance error of x-axis between unmanned plane and moving target.As shown in Figure 5, after adding above-mentioned horizontal direction Position Tracking Control rule, between unmanned plane and moving target, the relative distance error of x-axis is finally stabilized in the scope of 10cm, achieves the tenacious tracking to moving target.
Experiment proves, this control program is simple, Be very effective, the ability of unmanned plane is possessed tenacious tracking moving target.
Each loop is all adopt classical pid control algorithm from inside to outside above, need choose rational controling parameters, make the command signal of each channels track controller, improve its stability.The process of choosing of parameter is, first picks out each channel transfer function according to the result of modelling by mechanism and identification modeling, for the method successively design control law of single channel root locus; The parameter of design is transplanted to actual flying to go in the control algolithm of control plate, constantly tune is participated in the experiment and is flown, and finally obtains optimum parameter value.
Ginseng is adjusted through theoretical modeling and actual taking a flight test, the utility model achievement reaches the object of expection: can make six rotor unmanned helicopters under interference in air flow situation, keep automatically hovering mode or tracked mobile target, there is stronger automatic recovery ability, finally possess automatic flight performance, solved the problem of unmanned plane tracked mobile target in indoor are without GPS navigation situation.Meanwhile, design of hardware and software of the present utility model can apply to, on multiple many rotor unmanned helicopters, to possess certain practicality and versatility.
Claims (4)
1. a rotor unmanned helicopter follows the tracks of flight control system, it is characterized in that, comprise airborne portion and ground station control part, wherein, described airborne portion comprises six rotor flying platform and flight controllers, and described ground station control part comprises the detection and control terminal with wireless transmission function;
Described six rotor flying platforms comprise six groups of aviation mechanisms, frame and brushless The Cloud Terrace, and described six groups of aviation mechanisms are symmetrically located at six end points of frame, and described brushless The Cloud Terrace is fixed immediately below described frame;
Described aviation mechanism comprises electric mechanical, electrical mediation screw propeller, and described motor is used for carrying screws and rotates, and described electricity calls the rotating speed in adjustment motor;
Described flight controller comprises flight control modules, sensor assembly, vision guided navigation module, wireless transport module, power module and remote-control receiver;
Described flight control modules comprises main control unit and association's processing unit;
Described sensor assembly comprises six axle attitude sensors, electronic compass, ultrasonic height meter, radar sensor;
Described vision guided navigation module comprises camera and graphics processing unit, and described camera is arranged on brushless The Cloud Terrace;
Described main control unit respectively with six groups of aviation mechanisms, six axle attitude sensors, ultrasonic height meter, assist processing unit, graphics processing unit is electrically connected, described graphics processing unit is electrically connected with radar sensor, camera respectively; Described association processing unit and wireless data transmission module are electrically connected;
Described detection and control terminal and described wireless data transmission module carry out data communication by wireless.
2. six rotor unmanned helicopters according to claim 1 follow the tracks of flight control system, it is characterized in that, described power module comprises three pieces of batteries, is respectively six groups of aviation mechanisms of six rotor unmanned helicopters, flight control modules and vision guided navigation module and provides power supply.
3. six rotor unmanned helicopters according to claim 1 follow the tracks of flight control system, it is characterized in that, described main control unit adopts ATMEGA2560 single-chip microcomputer, and described association processing unit adopts ATMEGA32U2 single-chip microcomputer.
4. six rotor unmanned helicopters according to claim 1 follow the tracks of flight control system, it is characterized in that, described six axle attitude sensors adopt MPU-6000 six axle attitude sensor, described ultrasonic sensor adopts LV-MaxSonar-EZ1 sonic sensor, and described radar sensor adopts UTM-30LX signal laser scanning rangefinder.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201420788112.3U CN204314726U (en) | 2014-12-12 | 2014-12-12 | A kind of six rotor unmanned helicopters follow the tracks of flight control system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201420788112.3U CN204314726U (en) | 2014-12-12 | 2014-12-12 | A kind of six rotor unmanned helicopters follow the tracks of flight control system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN204314726U true CN204314726U (en) | 2015-05-06 |
Family
ID=53137031
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201420788112.3U Expired - Fee Related CN204314726U (en) | 2014-12-12 | 2014-12-12 | A kind of six rotor unmanned helicopters follow the tracks of flight control system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN204314726U (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104597912A (en) * | 2014-12-12 | 2015-05-06 | 南京航空航天大学 | Tracking flying control system and method of six-rotor unmanned helicopter |
| WO2019134142A1 (en) * | 2018-01-05 | 2019-07-11 | 深圳市大疆创新科技有限公司 | Unmanned aerial vehicle control method, unmanned aerial vehicle system, and control device |
| CN110138291A (en) * | 2019-06-28 | 2019-08-16 | 北京机械设备研究所 | A kind of motor driver based on ZYNQ dual core processor |
| CN113076601A (en) * | 2021-04-20 | 2021-07-06 | 中国直升机设计研究所 | Helicopter slope take-off and landing calculation and test flight method |
-
2014
- 2014-12-12 CN CN201420788112.3U patent/CN204314726U/en not_active Expired - Fee Related
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104597912A (en) * | 2014-12-12 | 2015-05-06 | 南京航空航天大学 | Tracking flying control system and method of six-rotor unmanned helicopter |
| WO2019134142A1 (en) * | 2018-01-05 | 2019-07-11 | 深圳市大疆创新科技有限公司 | Unmanned aerial vehicle control method, unmanned aerial vehicle system, and control device |
| CN110138291A (en) * | 2019-06-28 | 2019-08-16 | 北京机械设备研究所 | A kind of motor driver based on ZYNQ dual core processor |
| CN113076601A (en) * | 2021-04-20 | 2021-07-06 | 中国直升机设计研究所 | Helicopter slope take-off and landing calculation and test flight method |
| CN113076601B (en) * | 2021-04-20 | 2022-11-04 | 中国直升机设计研究所 | Helicopter slope take-off and landing calculation and test flight method |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104597912A (en) | Tracking flying control system and method of six-rotor unmanned helicopter | |
| CN104656664B (en) | Vehicle-mounted many rotor unmanned helicopter approaching and landing system control systems and guiding control method | |
| CN105353762B (en) | The control method of six rotor wing unmanned aerial vehicles based on double remaining attitude transducers | |
| CN204440169U (en) | The control system of the multi-modal autonomous flight of Miniature Unmanned Helicopter | |
| CN103365295B (en) | Based on the autonomous hover control system of four rotor unmanned aircrafts and the method for DSP | |
| CN104656660A (en) | Control system for micro-unmanned helicopter multi-mode autonomous flight and method thereof | |
| CN101515178B (en) | Master-slave burden type redundancy automatic unmanned aircraft pilot based on CAN bus | |
| CN205891228U (en) | Flying robot | |
| CN103611324A (en) | Unmanned helicopter flight control system and control method thereof | |
| CN107589752A (en) | Unmanned plane cooperates with formation realization method and system with ground robot | |
| CN103853156A (en) | Small four-rotor aircraft control system and method based on airborne sensor | |
| CN102424112A (en) | Three-layer airborne flight control device for micro four-rotor aerial vehicle | |
| CN204314726U (en) | A kind of six rotor unmanned helicopters follow the tracks of flight control system | |
| CN103365214A (en) | Single rotor wing unmanned aerial vehicle three-freedom degree semi-physical simulation platform and experimental method | |
| CN203825466U (en) | Airborne-sensor-based small-sized four rotor aircraft control system | |
| AU2019100363A4 (en) | Unmanned Aerial Vehicle And Its Program Control Device Unmanned Aerial Vehicle And Its Program Control Device | |
| CN105468009A (en) | System and method for multi-power integrated flight control applied in micro air vehicle | |
| CN107368087A (en) | Miniature four-axle aircraft and its control method | |
| CN102968123A (en) | Automatic pilot of unmanned aerial vehicle | |
| CN107264813A (en) | A kind of tailstock vertical takeoff and landing vehicle flight control system | |
| CN106325289A (en) | Renesas R5F100LEA master control-based four-rotor flight controller and control method thereof | |
| CN108706099A (en) | One kind is verted three axis composite wing unmanned planes and its control method | |
| CN102814047A (en) | Autonomous return system and control method of dual-rotor remote-controlled model helicopter | |
| CN202939490U (en) | Autopilot for unmanned aerial vehicles | |
| WO2018032430A1 (en) | Intelligent unmanned aerial vehicle system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150506 Termination date: 20161212 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |