Controller Design of the Draganflyer XP Quad Rotor...
Transcript of Controller Design of the Draganflyer XP Quad Rotor...
![Page 1: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/1.jpg)
Controller Design of the Draganflyer XP Quad Rotor UAV
An AA/EE449 project in collaboration with the UW DSSL
Andy BradfordAndrew Nelson
Justin Palm
![Page 2: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/2.jpg)
Open Loop Simulation
![Page 3: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/3.jpg)
![Page 4: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/4.jpg)
Closed Loop Simulation
Uses LQR controller
![Page 5: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/5.jpg)
![Page 6: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/6.jpg)
But we don’t understand LQR just yet, so we’re attempting PID control
![Page 7: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/7.jpg)
State SpaceA =
0 0 0 0 0 0 0 9.8100 0 0 0 0 00 0 0 0 0 0 -9.8100 0 0 0 0 0 00 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0
1.0000 0 0 0 0 0 0 0 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0 0 0 0 0 0 0 1.0000 0 0 0 0 0 0 0 0 0 0
B =0 0 0 00 0 0 0
-0.0297 0.0297 -0.0297 0.02970 0.5066 0 -0.5066
0.4954 0 -0.4954 00.2470 0.2470 0.2470 0.2470
0 0 0 00 0 0 00 0 0 00 0 0 00 0 0 00 0 0 0
C =
0 0 0 0 0 0 1 0 0 0 0 00 0 0 0 0 0 0 1 0 0 0 00 0 0 0 0 0 0 0 1 0 0 00 0 0 0 0 0 0 0 0 1 0 00 0 0 0 0 0 0 0 0 0 1 00 0 0 0 0 0 0 0 0 0 0 1
D =
0 0 0 00 0 0 00 0 0 00 0 0 00 0 0 00 0 0 0
![Page 8: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/8.jpg)
The Luenberger Observer
However… …and Heemstra’s Augmented matrices…>> R=rank(ctrb(Aaug,Baug))
R =
16
>> rank(Aaug)
ans =
20
![Page 9: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/9.jpg)
A Linear PID Control Approach
![Page 10: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/10.jpg)
Linear System Continued
![Page 11: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/11.jpg)
Where we go from here…
![Page 12: Controller Design of the Draganflyer XP Quad Rotor UAVdepts.washington.edu/soslab/mw/images/6/6a/Presentation.pdf · Controller Design of the Draganflyer XP Quad Rotor UAV An AA/EE449](https://reader034.fdocuments.us/reader034/viewer/2022050101/5f40368eba5d603607163fa6/html5/thumbnails/12.jpg)
Bibliography
B. Heemstra. (2010) Linear Quadratic Methods Applied to Quadrotor Control. Unpublished Masters thesis. University of Washington.
C. Balas. (2007) Modeling and Linear Control of a Quadrotor. Unpublished Masters thesis. Cranfield University. https://dspace.lib.cranfield.ac.uk/bitstream/1826/2417/1/Modelling%20and%20Linear%20Control%20of%20a%20Quadrotor.pdf
S. Bouabdallah, A. Noth, and R. Siegwart, “PID vs LQ control techniques applied to an indoor micro quadrotor”, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2004.(IROS 2004). Proceedings, vol. 3, pp. 1-6.
P. Castillo, A. Dzul, and R. Lozano, “Real-Time Stabilization and Tracking of a Four-Rotor Mini Rotorcraft”, IEEE Transactions on Control Systems Technology, Vol 12, No 4, July, 2004.
McKerrow, P. (2004), "Modelling the Draganflyer four rotor helicopter", 2004 IEEE International Conference on Robotics and Automation, April 2004, New Orleans, pp. 3596.
Dorf, R. C. Modern Control Systems. 1995. 10th. isbn 0201845598 . Addison-Wesley Longman Publishing Co., Inc. Boston, MA, USA pp. 660-672