Navigation Functionalities for an Autonomous UAV Helicopter

More documents

Recommendations

Info

104 APPENDIX A. Fig. 5. Mode sequence leading to touch down. Note that all transitions are onedirectional: once a mode is exited it can not be re-entered. throttle command is ramped down, inducing loss of lift and touch down. The control laws of the helicopter consist of an inner loop (pitch, roll and yaw angle control, and vertical velocity control) and an outer loop (position and velocity control). The inner loop consists of the Yamaha Attitude Control System (YACS), the properties of which have been identified with a dedicated system identification session. The control equations of the outer loop can be summarized as following: θC = KpxδX + KpvxδVX + KivxδVXsum ∆φC = KpyδY + KpvyδVY + KivyδVY sum VZC = KivzδVZsum + Kpvz(VZtarget − VZ) (6) VZtarget = limit(0.75δZ, VZmin, VZmax) ωC = limit(Kpwδψ, −26 deg/s, 26 deg/s) where the subscripted K are control gains, the δ are control errors, the subscript sum indicates the integral terms, θC is the commanded pitch angle, ∆φC is the commanded roll angle variation, ωC is the commanded yaw rate and VZC is the commanded vertical velocity 2 . 5 Experimental Results The helicopter used for experimentation is a slightly modified Yamaha RMAX (Fig. 1). It has a total length of 3.6 m (incl. main rotor) and a take-off weight 2 During the descent and touch down phases, the gains of the velocity terms (Kpvx and Kpvx) are increased by one fifth and the integral terms in the horizontal control are activated, for faster and more precise position control.
A.3. PAPER III 105 altitude [m] 20 18 16 14 12 10 8 6 4 2 0 0 2 4 6 8 10 12 14 16 18 20 distance to pattern [m] [mm] 400 350 300 250 200 150 100 50 altitude [m] 20 18 16 14 12 10 8 6 4 2 0 0 2 4 6 8 10 12 14 16 18 20 distance to pattern [m] Fig. 6. RMS error in horizontal (left) and vertical position (right) from simulation. of 95 kg, including 30 kg available for payload. The vision navigation system consists of two PC104 stacks with PIII 700 MHz processors, the inertial sensors of the YAS, and a single standard CCD camera with approx. 45 degrees horizontal angle of view which is mounted on an off-the-shelf pan/tilt unit (PTU). One of the two computers is dedicated to sensor management and low level control of the helicopter, the other one for image processing and control of the camera and the PTU. The two computers communicate over a RS232C serial link. They are built inside a shock and vibration isolated box, which also includes a precision GPS, a barometric altitude sensor, a compass, a video recorder, a video transmitter, and a wireless Ethernet bridge. The PTU is mechanically limited to 111 degrees tilt and ±180 degrees pan, the max. angular rate is 300 degrees/s and the resolution 0.051 degrees. It is mounted on a vibration isolating platform on the underside of the helicopter body. We estimated the RMS error of the vision system in position and attitude depending on the relative position to the pattern in leveled flight. For each position 1000 samples were generated using a feature noise model that included noise from image formation, digitization, and segmentation. We developed a method to analyze noise in ellipse center position and semi-axis length. Errors introduced by the transformation from the camera frame into the body frame were not considered in simulation. Fig. 6 shows the RMS errors (1σ) in horizontal and vertical position. The error doesn’t change much in the simulated envelope (a 20 m radius hemisphere, with a ”blind” sector from azimuth 0 to 15 degrees) due to different triplet sizes and sub-pixel feature extraction. For pitch and roll the error behaves similar to the horizontal error, with a maximum RMS value of ≈1 degree, the error in heading is negligible. The actual accuracy of the vision system was evaluated through an inflight comparison with a navigation solution based on the YAS and a precision RTK GPS which supplied horizontal/vertical position with 10 mm/15 mm [mm] 30 25 20 15 10 5
Page 1:
Linköping Studies in Science and T
Page 5:
Acknowledgements This work would ha
Page 9 and 10:
Contents 1 Introduction 1 2 Overvie
Page 11 and 12:
Chapter 1 Introduction An Unmanned
Page 13 and 14:
of the environment in order to avoi
Page 15 and 16:
Chapter 2 Overview This chapter pre
Page 17 and 18:
2.1. UAV SOFTWARE ARCHITECTURE 7 wh
Page 19 and 20:
2.2. THE UAV HELICOPTER PLATFORM 9
Page 21 and 22:
2.2. THE UAV HELICOPTER PLATFORM 11
Page 23 and 24:
Chapter 3 Simulation 3.1 Introducti
Page 25 and 26:
3.2. HARDWARE-IN-THE-LOOP SIMULATIO
Page 27 and 28:
3.3. REFERENCE FRAMES 17 3.3 Refere
Page 29 and 30:
3.4. THE AUGMENTED RMAX DYNAMIC MOD
Page 31 and 32:
3.4. THE AUGMENTED RMAX DYNAMIC MOD
Page 33 and 34:
3.5. SIMULATION RESULTS 23 3.5 Simu
Page 35 and 36:
3.5. SIMULATION RESULTS 25 Figure 3
Page 37 and 38:
3.5. SIMULATION RESULTS 27 Figure 3
Page 39 and 40:
Chapter 4 Path Following Control Mo
Page 41 and 42:
4.2. TRAJECTORY GENERATOR 31 Figure
Page 43 and 44:
4.2. TRAJECTORY GENERATOR 33 Fig. 4
Page 45 and 46:
4.2. TRAJECTORY GENERATOR 35 be use
Page 47 and 48:
4.2. TRAJECTORY GENERATOR 37 4.2.3
Page 49 and 50:
4.2. TRAJECTORY GENERATOR 39 radius
Page 51 and 52:
4.2. TRAJECTORY GENERATOR 41 Calcul
Page 53 and 54:
Page 55 and 56:
4.2. TRAJECTORY GENERATOR 45 by the
Page 57 and 58:
Page 59 and 60:
4.3. OUTER LOOP CONTROL EQUATIONS 4
Page 61 and 62:
4.4. EXPERIMENTAL RESULTS 51 Up [m]
Page 63 and 64: 4.5. CONCLUSIONS 53 1 + s 1 C(s) =
Page 65 and 66: 4.5. CONCLUSIONS 55 Vel [m/s] 20 18
Page 67 and 68: Chapter 5 Sensor fusion for vision
Page 69 and 70: composed of three accelerometers an
Page 71 and 72: 5.1. FILTER ARCHITECTURE 61 filter
Page 73 and 74: 5.1. FILTER ARCHITECTURE 63 north,
Page 75 and 76: 5.2. EXPERIMENTAL RESULTS 65 Figure
Page 77 and 78: 5.2. EXPERIMENTAL RESULTS 67 Figure
Page 79 and 80: 5.2. EXPERIMENTAL RESULTS 69 by the
Page 81 and 82: 5.3. CONCLUSION 71 vision system st
Page 83 and 84: BIBLIOGRAPHY 73 [9] E. Frazzoli. Ro
Page 85 and 86: Appendix A 75
Page 87 and 88: A.1. PAPER I 77 is a three-dimensio
Page 89 and 90: A.1. PAPER I 79 The reference point
Page 91 and 92: A.1. PAPER I 81 Path Av Err Max Err
Page 93 and 94: A.2. PAPER II 83 From Motion Planni
Page 107 and 108: A.3. PAPER III 97 A.3 Paper III Aut
Page 109 and 110: A.3. PAPER III 99 the projection of
Page 111 and 112: A.3. PAPER III 101 yes Tbo > Tlim2
Page 113: A.3. PAPER III 103 immediately afte
Page 117: A.3. PAPER III 107 Fig. 10. Flight
Page 121 and 122: Department of Computer and Informat
Page 123 and 124: No 598 Rego Granlund: C 3 Fire - A
Page 125 and 126: No 1024 Aleksandra Tešanovic: Towa
show all

Navigation Functionalities for an Autonomous UAV Helicopter

Create successful ePaper yourself

Delete template?

Save as template?