You are on page 1of 37

Chapter 5

Linear Design Models

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 1
Equations of Motion
<latexit sha1_base64="fwaG0cTglLFcbAvy+sI/weMfUCk=">AAALBXicpVbLbttGFKXTl8U+ErfLbi5qtLWh0qDUNOkmQNAsWnSVtLFjW5SJ0WgkEeFjOBxKMIhZ9x/6D90V3fY7+je9HA1JUZQdpyUg6Oq+5pz7GHHCwyCTrvvP3r133n3v/Q/2e/aHH338yf0HB5+eZUkuKDulSZiI8wnJWBjE7FQGMmTnXDASTUL2avL6WWl/tWQiC5L4pbzmbByReRzMAkokqvyD/d+9aSILrvwYvnoCRx5NMk8umCSgRZ4Fx7kNAH20ZUHs8UUAWmg7OWuhMpZhyyqsZWmH9ds5y7AVeJ5dgWIdUJXbraCMU785uuJyKygT5jQ5qzANCiNBA1uoEla+EerAsgpqwOoAZ1UdtcnCMMx1IrF00hWmmDcJdShoqN5MEFp4YpHAmU+uhvCrKoZeRLJMgfdDMB/VvgDP/OJcITkS8gU53khSGvwiVY3R5KWQYroys+q4e1MWSuIzpZogo6p9SwTjDtqXPj8yrvKbMvmxKirIhvpSU+crR+QYNm+KU9XRfiP9hj3ivfBdtUZ+gcgnmAjJ6m8Au2Z14XNlUk6AY6aauDGLxiyMuRVeFUVnN+K2TTQ2YddFqpmvNPM0d/hyi7kZlP/UfERwqXZ3/lJ3/q6Nv3yLxtecStiaFnDMkta7IEm1IX0Q9SI02jpe/1xnSOvddDCmXsX6pCyo/KpTMkZ3nNJomwtFB3o/kigi/gB4ikeYX0NIxcYmNcUfYJnUZgdg0tk7XX7uF65SWznW+tY87vK4aSq33HZM5+7zukN6m19nYNtN7lc1+hZebC52udd1bdNWbb8DLpraPjriV0NHXA2Pd1a4VVyKvH72r7t3m6lydEOVUb+e1ZKLFnb6lFfgzQvQylYvQXf4m9pU9IWmb/g+bk3W4P9NVglH3EBavHG0xN1GS9xttMQdR0u89Wg97I6W7T84dE9c/UBXGBjh0DLPc/9g7xdsBs0jFksa4iU5GrhcjgsiZEBDpmwvzxgn9DWZsxGKMYlYNi70W5SCL1EzhVki8BNL0NrNiIJEWXYdTdAzInKRbdtK5S7bKJez78dFEPNcspiuD5rlIcgEylcymAaCURleo0CoCBAr0AXBXkh8cbO9mK1ogjWKp3j5TZkaDceFWRxeMiPhIU5SLQ9xUFoxUzZjOOpeJhGPYCFetiIg8RwLUjzZdtZ/LeUXkpgVEZqxC4PtmneFs+HJ4NGJ++Lh4VPX9GPf+tz6wjqyBtZj66n1k/XcOrVob6/3dc/tDezf7D/sP+2/1q739kzMZ1brsf/+F1YTYhg=</latexit>

ṗn = (cos ✓ cos )u + (sin sin ✓ cos cos sin )v + (cos sin ✓ cos + sin sin )w
ṗe = (cos ✓ sin )u + (sin sin ✓ sin + cos cos )v + (cos sin ✓ sin sin cos )w
ḣ = u sin ✓ v sin cos ✓ w cos cos ✓
⇢Va2 S h cq i T ( ,V )
p t a
u̇ = rv qw g sin ✓ + CX (↵) + CXq (↵) + CX e (↵) e +
2m 2Va m
⇢Va2 S h bp br i
v̇ = pw ru + g cos ✓ sin + C Y0 + C Y + C Yp + C Yr + CY a a + CY r
2m 2Va 2Va r

⇢Va2 S h cq i
ẇ = qu pv + g cos ✓ cos + CZ (↵) + CZq (↵) + CZ e (↵) e
2m 2Va
˙ = p + q sin tan ✓ + r cos tan ✓
✓˙ = q cos r sin
˙ = q sin sec ✓ + r cos sec ✓
1 2 h bp br i
ṗ = 1 pq 2 qr + ⇢Va Sb Cp0 + Cp + Cpp + Cpr + Cp a a + Cp r r + 3 Q p ( t , Va )
2 2Va 2Va
2 2 ⇢Va2 Sc h cq i
q̇ = 5 pr 6 (p r )+ C m0 + C m↵ ↵ + C mq + Cm e e
2Jy 2Va
1 2 h bp br i
ṙ = 7 pq 1 qr + ⇢Va Sb Cr0 + Cr + C rp + C rr + Cr a a + Cr r r + 4 Q p ( t , Va )
2 2Va 2Va

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 2
Equations of Motion

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 3
Lift and Drag Models
Nonlinear model with stall e↵ects
<latexit sha1_base64="TDpREYxDldVgd78Ltq9JBRX+oG4=">AAAF1HichVNLb9QwEA4tC2V5tXDgwMWwArW0XW0iXhKqBGoPHAoCRAvSOl053knWqu0E29uycn1CXDjw//gZ/AOcTfrYFISlyJP5ZsbzzSMpONOm1/t1YW7+YuvS5YUr7avXrt+4ubh0a1fnY0Vhh+Y8V58TooEzCTuGGQ6fCwVEJBw+JfubJf7pAJRmufxoJgXEgmSSpYwS41WDpbkfWOZMDkEaZHGSore5LGMRhUQ+BI4OmRkhbQjnCNIUqNGujRPImLSEs0w+cu3NwfYyJrwYkRX0cANhDqlZDtexZpkgxwhWLBuZlQrtbw7s9qDn0CqaSrYycq66UWUce3g2SO0d4RfYwFdjPSjdyQuayb2o+sE0141YGLcbwXyuCKeKUBuuwp5df1Mj69U16K24Un+sXj1VO1uT/JdfzfaM1V+i1EauTM2XYcudzaxUDIqyQlWKy42S1RVDtcte5HMqGAL06oNvEMjhSXva+EAXhIINqSj/Zvu9fabZ/+vs/7pW0tg6R+LYYavp0EizPVjs9Lq96UHnhbAWOkF93vnpDfEwp2Ph2VBOtO6HvcLElijDKAdPZ6zBU98nGfQ5GAOqIAWoNSSI8jw3ou4TJmObQS7AqMmsgxclEaBjO10zhx54zRClufKfL99Ue9bDEqH1RCTeUhAz0k2sVP4N649N+jy2TBZjA5JWD6VjjkyOyp1FQ6b84vGJFwhVzJNDdET8VHhCPpKEQ5oLQXwxcTEE149iWw0NLspSEN4J3akcOTfrM4QUvngDv+V0XwG32ChGZOYraDeaxsKX2ZWXJ5Fa0YSV96nQJLEfXBOWuRKuH8bV/uCjTlgtAT5ys9XiWe6JjgSjaydyIxZJ9Gmok0izgfoylxDb0aQY+WYaNx2ysDlS54XdqBs+7Ubvo87Lx/W4LQR3g/vBchAGz4KXwevgXbAT0Lnf83fm0fy91m7rqPWt9b0ynbtQ+9wOZk7r5x+OVfex</latexit>

⇥ 2

CL (↵) = (1 (↵)) [CL0 + CL↵ ↵] + (↵) 2 sign(↵) sin ↵ cos ↵
1 + e M (↵ ↵0 ) + eM (↵+↵0 )
(↵) =
1 + e M (↵ ↵0 ) 1 + eM (↵+↵0 )
(CL0 + CL↵ ↵)2
CD (↵) = CDp +
⇡eAR

Linear model

CL (↵) = CL0 + CL↵ ↵


CD (↵) = CD0 + CD↵ ↵

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 4
Coordinated Turn – No Wind

<latexit sha1_base64="t2q5R3shYvsIPPhexUSYQ/NDHEw=">AAACbHicbVFNb9QwEPWmfJTlqwVuFVLEqqinVbIH4IJUiQvHgti20iaqJs5k16rtBHsCWlkRF85cgSN/gv/Cn+A3MNmtBN0ykuXneW/kmTdFo5WnJPk1iLauXb9xc/vW8Padu/fu7+w+OPZ16yROZa1rd1qAR60sTkmRxtPGIZhC40lx/qrnTz6g86q272jZYG5gblWlJFCfyhqvznZGyThZRXwVpBdgdLi1/+nn988/js52B2+zspatQUtSg/ezNGkoD+BISY3dMGs9NiDPYY4zhhYM+jysmu3ifc6UcVU7PpbiVfbfigDG+6UpWGmAFn6T65P/42YtVS/yoGzTElq5/qhqdUx13E8el8qhJL1kANIp7jWWC3Agif0ZZhY/ytoYsGXImhK72SQPWcU0P/vJQI/S7i+edN3lmhIrfM8CT9yPQx0ycgrsnA0JLzfFhl3r+ouHqIJhmreQbnp+FRxPxumzcfKG13Eg1rEt9sQTcSBS8VwcitfiSEyFFAvxRXwV3wa/o0fRXvR4LY0GFzUPxaWInv4BQFvC/w==</latexit>

mVa ˙
<latexit sha1_base64="WwabEaPS7bptV9VuUIZ7mHJZRbc=">AAACf3icbVFNbxMxEHWWrxK+UhAnLhYRoqdoN0IFDkiVuHAsiKSVsqto1jubWrW9W3sWFFn+MVzbX8S/wZtGgqaMZPn5vRl7/KZslXSUpr8HyZ279+4/2Hs4fPT4ydNno/3nc9d0VuBMNKqxpyU4VNLgjCQpPG0tgi4VnpTnn3v95AdaJxvzndYtFhpWRtZSAEVqOXqZa3COz5fA86ohn7dOhuFyNE4n6Sb4bZBtwZht43i5P/gWy0Wn0ZBQ8cZFlrZUeLAkhcIwzDuHLYhzWOEiQgMaXeE3/Qf+JjIVrxsblyG+Yf+t8KCdW+syZmqgM7er9eT/tEVH9YfCS9N2hEZcP1R3ilPDezN4JS0KUusIQFgZe+XiDCwIipYNc4M/RaM1mCr6UmFYTAuf11GOx/5noMZZ+IunIdysqbDGi5jgKPZjUfmcrASziob4T7vJ/RxCv8VP1F6HzRSyXc9vg/l0kh1O0q/vxkcH23nssVfsNTtgGXvPjtgXdsxmTDDPfrFLdpUMkrfJJEmvU5PBtuYFuxHJxz9t98WP</latexit>

˙ about ki axis
<latexit sha1_base64="76lV1KWna/cV/y85nDlPunwnAaM=">AAACkXicbVFNbxMxEHWWj5bwldIjF4sE0VO0mwOUA1IEFyQuBZG2UnaJvN7Z1IrtXexZILL2J/BruMIP4d8wm0aCpoxk6fm9GXvmTV5r5TGOf/eiGzdv3d7bv9O/e+/+g4eDg0envmqchJmsdOXOc+FBKwszVKjhvHYgTK7hLF+96fSzL+C8quxHXNeQGbG0qlRSIFGLwbNRWlQY0tqrdsRFXjXIR6kReJGXYdV+UkR+U76/GAzjcbwJfh0kWzBk2zhZHPQ+0MuyMWBRauH9PIlrzIJwqKSGtp82HmohV2IJc4JWGPBZ2EzU8qfEFLysHB2LfMP+WxGE8X5tcsrsevW7Wkf+T5s3WB5nQdm6QbDy8qOy0Rwr3tnDC+VAol4TENIp6pXLC+GERDKxn1r4KitjhC3IsgLa+SQLaUkyXbvJhB4m7V88adurNQWU8JkSPFI/DnRI0Slhl2RIeLWbbMi1NmyW4ctgSKYtJLueXwenk3HyfBy/nwynR9t97LPH7Ak7Ygl7wabsLTthMybZd/aD/WS/osPoZTSNXl+mRr1tzSG7EtG7P5sYzJM=</latexit>

mg
<latexit sha1_base64="T/JkFJRsx9YUOwa6nlhEPICjKqM=">AAACcHicbVFNT9wwEPWmtMD2C9pLpR5wu6qEelglK0S5ICH10iNULKy0idDEmSwWtpPaE6qVlT/Ra/vH+jf6C+osKwELI1l+nvfGnnnOayUdxfHfXvRk7emz9Y3N/vMXL1+93tp+c+aqxgoci0pVdpKDQyUNjkmSwkltEXSu8Dy/+trx59donazMKc1rzDTMjCylAAqpSarBOT7rX2wN4mG8CP4QJEswYMs4vtjufU+LSjQaDQkVLpkmcU2ZB0tSKGz7aeOwBnEFM5wGaECjy/yi4ZZ/CpmCl5UNyxBfZO9WeNDOzXUelBro0q1yXfIxbtpQeZB5aeqG0Iibh8pGcap4Nz0vpEVBah4ACCtDr1xcggVBwaN+avCnqLQGU/i0LrCdjjKfloEOx24yUIOkvcWjtr1fU2CJP4LAUejHovIpWQlmFgzxh6vizvq228IQpdeBDr+QrHr+EJyNhsn+MD7ZGxztLv9jg71nH9kuS9gXdsS+sWM2ZoIp9ov9Zn96/6J30U704UYa9ZY1b9m9iD7/B6TfwMk=</latexit>

Flift cos = mg
<latexit sha1_base64="+SDEKqiBDGm8FOYDC8NSwSWuMSw=">AAACjHicbVFNaxsxEJW3X4nbpk57zEXEFHoyuyakhWIIFEKOaamTgLUYrXbWFpG0W2m2rRG699f0mv6V/ptqHUMbpwNCT/PeSDNPRaOkwzT93UsePHz0+MnObv/ps+d7Lwb7Ly9c3VoBU1Gr2l4V3IGSBqYoUcFVY4HrQsFlcf2h4y+/gnWyNp9x1UCu+cLISgqOMTUfHJ7OPUP4jl7JCkNgonasWUo6oUxz5+iiPx8M01G6DnofZBswJJs4n+/3PrGyFq0Gg0LFS2ZZ2mDuuUUpFIQ+ax00XFzzBcwiNFyDy/16mEBfx0xJq9rGZZCus/9WeK6dW+kiKjXHpdvmuuT/uFmL1bvcS9O0CEbcPlS1imJNO2doKS0IVKsIuLAy9krFklsuMPrXZwa+iVprbkrPmhLCbJx7VkU6HrvJuBpm4S8eh3C3poQKvkSBw9iPBRVtt5KbRTTET7bFnfWh2+IQldeRjr+QbXt+H1yMR9nxKP14NDxJN/+xQw7IIXlDMvKWnJAzck6mRJAf5Ce5Ib+SveQoeZ9MbqVJb1PzityJ5PQPJb7LJw==</latexit>

v2
<latexit sha1_base64="pS2yt2j/g9F0mPWb1cSu+IL+0ZY=">AAACz3icbVHLbhMxFHWGR0t4pbBkYxGBWEUzEQI2lSohIZZtRdJKcYgcz53Equ0ZbE/ayDJiy7fxBXwGW9hwJwmCJlzJ8tE59/pxzrRS0vk0/d5Kbty8dXtv/0777r37Dx52Dh4NXVlbAQNRqtKeT7kDJQ0MvPQKzisLXE8VnE0v3jb62QKsk6X54JcVjDWfGVlIwT1Skw68mwTm4coHJQsfI3PSsGou6fNDyjR3jhWWi7D42I/hNFLG2hTrj0gXlJUaZnxHGE6Qy0sfWOVknHS6aS9dFd0F2QZ0yaaOJwetU5wWtQbjhcIDR1la+XHg1kuhILZZ7aDi4oLPYITQcA1uHFZ+RPoMmZwWpcVlPF2x/04Erp1b6il2au7nbltryP9po9oXb8ZBmqr2YMT6oqJW1Je0MZfm0oLwaomACyvxrVTMORroMYI2M3ApSq25ydGWHOKoPw5rf1nV/Iyrbhb/4n6M12dyKOATNjiP77GgMDkruZmhIeFwu7mJITYbfqIIGmVMIdv2fBcM+73sVS89edk9Sjd57JMn5Cl5QTLymhyR9+SYDIgg38gP8pP8Sk6Sy+Rz8mXdmrQ2M4/JtUq+/gaPUuM9</latexit>

Flift sin =m
R Va ˙
<latexit sha1_base64="MLXkYDs0BndV2U5oK2en6O8GhF0=">AAAC/nicbVFNj9MwEHXC1xI+tgtHLhYVCDhUSYUAabXSSnDguCDaXamuKteZpNbaTmo7hcqyxI/gN3BDXPkr/BVOOG1Fd7uMZOdp5s2L5820FtzYNP0dxdeu37h5a+92cufuvfv7nYMHQ1M1msGAVaLSZ1NqQHAFA8utgLNaA5VTAafT87dt/XQB2vBKfbLLGsaSlooXnFEbUpPON6IqrnJQNiEWvlj3ji94zlWJS74Ag7HHZD5vaI6JpYrUM46fHmFSaMrccEJJXllHasO9d6UnZCNCVX6xc30fkkO85W9lSt8q+X/6OJl0umkvXQW+CrIN6KJNnEwOoo9BmTUyzMEENWaUpbUdO6otZwJ8QhoDNWXntIRRgIpKMGO3ss/jJyGT46LS4SiLV9mLHY5KY5ZyGpiS2pnZrbXJ/9VGjS3ejB1XdWNBsfWPikZgW+F2FzjnGpgVywAo0zy8FbMZDZ7YsLGEKPjMKimDmcGyHPyoP3Zry0jdTkZFN/Nb3Pf+ck8OBcwDwdjwHg3CEas5VWUwxB3tkmVwzbefMEThZCiHLWS7nl8Fw34ve9VLP7zsHqebfeyhR+gxeoYy9Bodo/foBA0QQ38iHD2PXsRf4+/xj/jnmhpHm56H6FLEv/4CDMH18g==</latexit>

= mv! Dividing gives tan =


g
= mVa ˙ ˙ = g tan
and
Va

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 5
Coordinated Turn

v2
Flift sin cos( )=m Flift cos = mg cos
R
= mv!
= m(Vg cos ) ˙

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 6
Coordinated Turn
Dividing the two expressions gives
<latexit sha1_base64="HGN5GtfSjYSlj/rJxKGbtPB5qx8=">AAAETHicfZPPb9MwFMezdowRfnVw5PLEijQkqNJK/LhMmgRCcBto6yY1XeU4L4k1x45sp6WK8gdy4cCNv4ILBxBCws7KVjrAUiTrvef3Pt9v7KjgTJsg+LzWaq9f2bi6ec2/fuPmrdudrTtDLUtF8ZBKLtVxRDRyJvDQMMPxuFBI8ojjUXT6wuWPpqg0k+LAzAsc5yQVLGGUGBuabLWiUEgmYhQGXrIpi5lIwWQIZiYB39te2p3VkLIpaj8c+WEsTRXSjNWwC2GiCK3SuhpO0jo0RIRFxkIq9Y6reBwWmj30w7E/yxjNgOmmNZVS2TnEYAymVMIGRMwcDzABM0vjh1NdEIpV0Os/YaL2/QvKN6JpQiKNgiLIpDnxCGYIGZkidIcTsmtxukBEDF2HsOtgunAGsSLEpleEkHMhl8gvDLHMeS4Fn4NGbLhdnjODilhNCP+TcOD8tcKd14rErNRugAMTEM0d27tzJKvE+RmmJM9JXV24Xy+XnAyWi9J//InaCVrieCUVcJwih4SzNDO/Zax4e26ty2nbOiYqhkSqvORklZacDJYAmomTznbQC5oFlzf9xWbbW6z9SeeTlUnL3DJSTrQe9YPCjCuiDKMcbc9So/X2lKQ4sltBctTjqnkMNTywkYbOflZjE10+UZFc63ke2cqcmEyv5lzwb7lRaZLn44qJojTWnbNBScnBSHAvC2KmkBp7I2JGqLL3mQLNiHXF3gntTOivSr68GQ56/ae94O1gey9Y2LHp3fPuezte33vm7XmvvX3v0KOtD60vrW+t7+2P7a/tH+2fZ6WttcWZu94fa33jF+dIapw=</latexit>

g
˙= tan cos( )
Vg

which is the coordinated turn condition in wind

In the absence of wind, we have Va = Vg and = which gives

˙ = g tan
Va
which is the expression commonly seen in the literature

The turning radius is given by

Vg cos Vg2 cos


R= =
˙ g tan cos( )

For level flight in the absence of wind we have the standard formula

Va2
R=
g tan

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 7
Trim Conditions

Given the nonlinear system


<latexit sha1_base64="qNUd83zUwWOauTAmommkxj3Yoz4=">AAADZnicbVJNb9NAEHUSPloD/RTiwGVEitRKUeT0AFyQijgAtyI1baU4jcbrcbKqdx12x1Eskz/JjTMXfga7aSRKwkqWn97MvN33NMk0l5aj6Gej2Xrw8NHjre3wydNnO7t7+weXtiiNoL4o8sJcJ2gpl5r6LDmn66khVElOV8ntR1+/mpGxstAXXE1pqHCsZSYFsqNG+43vYawLqVPSDJ/kjDTwhEAX2iuiAVtZJhXGgzBOC67nC3gP2fG8U56E8TC8cL30rZS5TIxEODqe38RouQPl8n9yBGgIUsqcWApJBV7Ijd/UvrzolCtw4lQjLxjGMztFQXVPqEV4720fNKA0wmDGIPXfS0sF0noGoY5JARupQBQ6ld7gogvwRcOYNBnMO2tVCwqrUGqRlymBZWSyzj7y8tW6YN/qaM1Oxlk1lBWGNlV893iZXVLdS2rl7S6wDcfe7WivHXWj5YFN0FuBdrA656O9H05blMolInK0dtCLpjys0bAUOS3CuLTk4rvFMQ0c1KjIDuvlmizgtWNScBbcp703x96fqFFZW6nEdSrkiV2vefJ/tUHJ2bthLfW0ZNLi7qKszIEL8DsHqTQkOK8cQGFcaALEBA0KdpvpQ+itW94El6fd3ptu9PW0fXa6imMreBm8Co6DXvA2OAs+B+dBPxCNX83t5kHzsPm7tdN63npx19psrGYOg39OC/4AaNMQCg==</latexit>

ẋ = f (x, u)
The equilibria (x⇤ , u⇤ ) are defined by

f (x⇤ , u⇤ ) = 0

An aircraft in equilibrium is in a trim condition. In general, trim conditions


may include states that are not constant. Therefore, trim conditions are given
by
ẋ⇤ = f (x⇤ , u⇤ )

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 8
Calculating Trim
Objective is to compute trim states and inputs when aircraft
<latexit sha1_base64="Nqlk4EiMHy9cPCWtvM6K2+E2wJI=">AAAFxXicbVTfjxs1EN7eETjCr1555GVEDlTQKkoiCqhSpUp9gD5RSu9aKQ7RrHd2Y8727tneXMN2xd/JK38Js5tccsnVUrxjz8w3429mkpRa+TAa/Xvv6PiD3ocfnXzc/+TTzz7/4v7pgwtfVE7SuSx04d4k6EkrS+dBBU1vSkdoEk2vk8tnrf71kpxXhX0VViXNDOZWZUpi4Kv56VEtbKFsSjbAb8lfJINaEigPoQBZmLIKBMEpAz5gIN9Hm4KyfO3hekEWUDnpMAvglal0QEtF5fUKPOP7TBEDLRwRY9lUtSH9475IKFe2VoGM+puaPoBoZXjlcNk+JAcMrQOH5Kx8SZTC2cUc/6wF+tCcbR2eaWWSQ/tMq3wRoMSwALS5JjgTORpz1/253XkVLlG8Z+AwVZWHs5dbc0E23SXbF0tfoqR6NHwkTXve8nc7x/gwagwtdTtYPju6oZLJDosN0RK1rHRXHv+eaGvukB9pv2/6ItDbUP/R1eZxA9+CuLqqMIW3IqWMruBhObcxlHNqtzSGKoZlDNcxiHKheOeoAduT51MZw1UM7jtOMRRlA0Js8J93Wd7Gr27w+ctVb/E3UthKuJW2kGsub5Lvz+8PRsNRt+CuMN4Ig2izXnC7jkVayMow3VKj99PxqAyzGl1QUnN1ROWJ+brEnKaaQiBXYkkuBoOOeXsyGT5SdlbnVBgKbrXvwKJFQ35Wd3PVwDd8k0JWOP7ZtsX49rZHjcb7lUnY0nC7+UNde/k+3bQK2c+zuis+WbkOlFW66wMeUkiV40nkMUoVSsdzI0Eu0KHkBzGSpWueTcMNVYsypWY6mdUiYzUfWypQD8bNTp40zb5PVzs24NaXl440F8epblaa+smhsWGam/bDj8hqc6h27LPWJkn9sjlU28KZZjrm/DRlQbwbjIVr51O8a/bZ0nnBD10YJeOtfICFid9BbZH2gaa2sDSrF6uS/50wrJtsfNhSd4WLyXD843Dy+2Tw9IdNu51EX0VfRw+jcfRT9DT6NXoRnUfy6L/jk+PT4we9X3qmF3rLtenRvY3Pl9He6v3zP1Zs90Q=</latexit>

simultaneously satisfies three conditions:


• Traveling at constant speed Va⇤

• Climbing at constant flight path angle

• In constant orbit of radius R⇤

Va⇤ , ⇤
, and R⇤ , are inputs to the trim calculations

4
States: x = (pn , pe , pd , u, v, w, , ✓, , p, q, r)>
4 >
Inputs: u = ( e, t, a, r )

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 9
Calculating Trim
For constant-climb orbit:
<latexit sha1_base64="7PD539Pjcyxyc9eQ6FIGdZGWT+4=">AAAM6nictVbbjhtFEO0sgQRjIAuPvLRYgwLatWwrFxS0UqRIwGOIsptIHrPqafdctHPbnvZurGF+gjfEKx/EK3/D6fJsYs/Fa0ViRp6pqTpVXXWq3DNuFoW5GY3+vbX3we0PP7pz9+PeJ/1PP/v83v4Xp3m60FKdyDRK9WtX5CoKE3ViQhOp15lWInYj9co9f2btry6VzsM0eWmWmZrFwk9CL5TCQJXu3/6HOSxhKQtxnTOFq2EcOgP5Da4u81jBfgJCQy9xT1gOvSDkETQRfGPgOGFcPBn2hJUUxWG91vgDaDV0PgsolsaZsivoOaJnwCmgbUQPVwGkxkoakkf+NqKhfALKxKf4/g2RrW1OngVbIMPfcHeAsfWU7HjNernVetViHdEK71exlSKcnGqxdWfEoq2OV/VFiJS3dODminN2Dt8r9mCtAgcrBPBpq7Idb4BXFH+bz8M1n2wrhxc3cNjO4kv0TUPmNAt2RtsYuWbRTsUl+XLM5ZJiunheTUsB6QLxbJyQYnyPLHpbGMtbGOPI2+bsUUYStlN2BmkTVeLpRUNn/Wz2OUk+LDHOuq+1rfKck9zW6zrmOmvdyNdhh3g+rqQR1auIry4+2jvxbO1/392Lw/+pG0FHH9q45xTDrtHN8W4sXNLeZLusgBti2iVidXP081rFGXXLrq6IK01dH7RmPCDeBlvyHWwwO2jM1souCXG9o0pk44H3zX3wTYPJAUXOd+iOgxkQhIoqxBOaigSyrfYIaE1TcoR1AvJerbtivDuHVTfvb/S/vrecYZ1mp3+kud7up7b48Wpedpu5ul/326Ub23zXdGObb57dcu/a73f17t79d1+/fffcpWO7stN8p3RjmzvjOva7ymaAzt57f5jUdohgwz5Z20HuVzunoX/Pwn798G+RBfzO7h2MhiM6eFMYV8IBq47nZ/t7Y2eeykWsEiMjkefT8Sgzs0JoE8pIlT1nkatMyHPhq2mkjFE6E5nShzwW2g+T48nwYZjMCl+lsTJ6uekAMRGxymcFfXyW/Bto5txLNX6J4aRd9yhEnOfL2AUyFibI6zarbLNNF8b7YVaESbYwKpGrhbxFxE3K7Zcsn4daSRMtIQipQxTHZSC0kCgIkRJ1JdM4Fsm8cLK5KqeTWeF4MOPRUiGig3H5Tp6U5abPXHnqAoDcIB+tosIxOhSJDwaL4zo4Bs2lvaEIr4jrZg2fldV1ixdl3ZykOi6nY+QXKc84vx+MHR36AaRyk63IT1FoEIfy8K1ciyXc/F2ot5E2A02TNFGzIlhmAZppyp4dsnF9pJrC6WQ4fjSc/Do5ePqgGre77Cv2NcZ3zB6zp+wX9pydMNm70zvqPeo97kf9P/p/9v9aQfduVT5fso2j//d/WXrc3A==</latexit>

! speed of aircraft not changing ! u̇⇤ = v̇ ⇤ = ẇ⇤ = 0


! roll and pitch angles constant ! ˙ ⇤ = ✓˙⇤ = ṗ⇤ = q̇ ⇤ = 0

Turn rate constant and given by



˙⇤ = V ⇤
a
cos ! ṙ⇤ = 0
R⇤
Climb rate constant, and given by

ḣ⇤ = Va⇤ sin ⇤

Given parameters Va⇤ , ⇤


, and R⇤ , can specify ẋ⇤ as

ẋ⇤ = (ṗ⇤n ṗ⇤e ḣ⇤ u̇⇤ v̇ ⇤ ẇ⇤ ˙ ⇤ ✓˙⇤ ˙ ⇤ ṗ⇤ q̇ ⇤ ṙ⇤ )>

(continued. . . )
Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 10
Calculating Trim
Given parameters Va⇤ , ⇤
, and R⇤ , can specify ẋ⇤ as
0 1 0 1
ṗ⇤n [don’t care]
B ṗ⇤e C B[don’t care]C
B ⇤C B ⇤ C
B ḣ C B Va sin ⇤ C
B ⇤C B C
B u̇ C B 0 C
B ⇤C B C
B v̇ C B 0 C
B ⇤C B C
Bẇ C B 0 C
⇤ B C B
ẋ = B ˙ ⇤ C = B C = f (x⇤ , u⇤ )
0 C
B C B C
B ✓˙⇤ C B C
B C B V⇤ 0 C
B ˙ ⇤ C B a⇤ cos ⇤ C
B C B R C
B ṗ⇤ C B 0 C
B C B C
@ q̇ ⇤ A @ 0 A
ṙ⇤ 0

Problem of finding x⇤ and u⇤ such that ẋ⇤ = f (x⇤ , u⇤ ), reduces to solving


nonlinear algebraic systems of equations
Can use Matlab trim command – see Appendix F

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 11
Lateral Transfer Functions - Roll
<latexit sha1_base64="gF35L7q81CV2QdNBNxaTSy3AhGs=">AAAJV3ic1VZfb9xEEHcK9C7mX1N442VEjipplNOdUQFVilRUBLxRVJJWyh7Wej0+L7XXvt11omD5Q/BpeIWP0U8Ds/ZdfJeEIhAPdF9ud/a3M/v77dyMozKTxk4mL7duvfHmW7cHw23/7Xfefe/9Ozt3T0xRaYHHosgK/TziBjOp8NhKm+HzUiPPowyfRS8eu/1nZ6iNLNQP9qLEWc7nSiZScEumcGdwn6lCqhiVhZpFCXwX/YTCyjN82AB8TTtgZF5mCFZzZRLUkFRKuMOgMWu9mFSWEKE9R1QwYmUqR8Dp4IjFmFke8pHvszNTcoH1OHgg8obWabeejj91BnhqubZwLm36ENzBwtbOUQNHACUcwIIZqZyFWa6YTdFysmomCrNpvR6rJ/ilMVUu1Rxsyi1F6Q6ANGBynmXtpWNMpOowCE5VruXPLU1ArQsNe4IrYguCiMsYNcbADXC3trrIIKZHq3TElcB9sAVB/VEctmzCaQOkSYKLf8AH5vQYxmen/oYqTpTerc9m/lcyoechnpKuSwQcG1NFhrKiag0J3X5N2kvPEc6lqnkm5+o+eYr7MPeOoMWXDUVrZ3GzRoX5DvANz3MeTqFcwOFqFcBC+7A26HiiuainTR00TKcFnIT8xwCeQgQsw8SebsAfh3UZ1pOmueKks9ONLW/oAu73JgTdtwsXQUkBKdSNjnQP06+A1as8btrna6evwuketykC03Ke2hm8rmIuNYK9PokO+xzcfz0k7hTaa0/9tYw3M/f7EPvQi+AfwMrt37lcI3rF2ZI0Y3CPLRYVj33HwTlldQf9P+XG4bU/2mVy/LcZ8e9eut1j7ZO7InbI1wvwZXk7gJU96NNura4GVA1RxavSGN7ZnYwn7YDrk+lysustx5NwZ+tDiiaqnIqyyLgxp9NJaWc1tTopMiTvlUFqVS/4HOu2lzfwCZnitlQn1FCgtW7geG7MRR4RMuc2NVf3nPGmvdPKJl/MaqnKyqISXaCkylyLch8G1Lc0Nf7sgiZcaEk3BJFyeihLnw/URPFcFJRxJAfLiUrjfihGUudNs7nddjjaN5ZC00dCzayWXM2JcX1EYNJxelW165OTYDz9bBx8H+w+miwVHXofeR97e97U+9x75H3rPfGOPTH4ZfDr4LfB78OXwz+2b28PO+itreWZD7yNsb3zJ7ne5mo=</latexit>

Objective: Find simple transfer function relationship between and a

Start with: ˙ = p + q sin tan ✓ + r cos tan ✓


Assuming that ✓ is small and defining the linearization error (can be considered
4
as a control disturbance) to be d 1
= q sin tan ✓ + r cos tan ✓ gives

˙ =p+d
1

Di↵erentiating and substituting for ˙ gives


¨ = ṗ + d˙
1

1 2 bp br
= 1 pq 2 qr + ⇢Va Sb Cp0 + Cp + Cpp + Cpr + Cp a a + Cp r r + d˙ 1
2 2Va 2Va

1 2 b ˙ br
= 1 pq 2 qr + ⇢Va Sb Cp0 + Cp + Cpp ( d 1 ) + Cpr + Cp a a + Cp r + d˙ 1
2 2Va 2Va r

✓ ◆ ✓ ◆
1 2 b ˙+ 1
= ⇢Va SbCpp ⇢Va2 SbCp a a
2 2Va 2
⇢ 
1 2 b br
+ 1 pq 2 qr + ⇢Va Sb Cp0 + Cp Cpp (d 1 ) + Cpr + Cp r + d˙ 1
2 2Va 2Va r

= a ˙ +a a+d
1 2 2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 12
Equations of Motion

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 13
Roll Dynamics
Linearization leads to second-order ordinary di↵erential
<latexit sha1_base64="G1DgEkNXTvUNhw5dHG6TWry+hMU=">AAAEonicbVLbbtNAEHVKgGJuLTzysiIgpWqJ4kgFXipV4gUQDy3QixRb0Xo9jlfdXbu761Zh62/jO/gAXuEXGDtp0qSsZHs0M2d85uyJC8GN7fd/tdbutO/eu7/+wH/46PGTpxubz45NXmoGRywXuT6NqQHBFRxZbgWcFhqojAWcxGcf6vrJBWjDc/XdTgqIJB0rnnJGLaZGm63TUOVcJaAs+YIzqOY/mhIRQBNDbE4MsFwlb3KdgCb45orqCUl4moJGGKeCwHnZgPxw6IdJklsXFhmvyB55Q0dNPAoqEi4K2+Q6P6jzICwdUcwm86wfRr4fXpiCMnD93i6TmLqm6n9SxGqqDFIgaalYwzjNtSSXQDJ6AQ0TnNQ1W8giFJDaLglTTZlb/Llypmu2Fwy3kIvm48xuzRD+NbV6zPYMH1Q3R9ygXDfN8Mh+tNHp9/rNIbeDYBZ0vNk5GG2uBagQKyUuyAQ1Zhj0Cxs5qi1nAnD90gDKcUbHMBRgLeiCFqB3iKR6zNXeoLfLVeTGkEuwerIMwFBRCSZyjWkq8hozSa0ZPnj5TfYmwlFpzETG2CmpzcxqrU7+rzYsbfo+clwVpQXFpj9KS1FbqXYgOkcDs6K2EGWa43KEZRSVxYVwkoJLlktJVYK6JlANB5GbCh8WtRRUdPAG5jFewTImgRTOscFY5KNBuNBqTtUYFXR7q80SZa7qDy6ROrla1oiZVuPYfa1WywoNVw0D5Fe7JbzqBNPrD6+qZbXEOMdFM8nZzjxemUVjsxg1n7Q8aKhyBZHLJkWGl2kr30eTBauWuh0cD3rB297gcNDZH8zstu698F56XS/w3nn73kfvwDvyWOtn63frT+tv+1X7c/uw/W3autaaYZ57S6cd/gNeKJIM</latexit>

equation
¨= a ˙ +a a+d
1 2 2

In transfer function form we have


✓ ◆✓ ◆
a 2 1
(s) = a (s) + d (s)
s(s + a 1 ) a 2 2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 14
Lateral Transfer Functions - Course
To derive transfer function from roll to course ,
<latexit sha1_base64="u+vZEOXk2O3TBhSkrHqkDQjNhXs=">AAAFbnicjVPLbttGFGXUKE2Ydwt0UxQZVE5gJ7YqCkjTjYEU3WSZFLETQCMIw+ElOfA82JmhDWHCL8jXZNt+Sf+in9A7omJbchbhRlf3fe45kzdSOD+Z/Htt8M314Y1vb95Kb9+5e+/+g4ffHTvTWg5H3Ehj3+fMgRQajrzwEt43FpjKJbzLT/6I8XenYJ0w+q1fNjBXrNKiFJx5dC0eDnaoNkIXoH361pACrDgF4i3TrgRLylbzmEhKaxSxRkqyQ5ta7BBvCMclHKCDo2Of0tR5Zj05E74m2hycYVvMMbYQmnkoiG+tRocuRGyZ0llKC+NDLO/IIaGlZTxUXTheVB2hnuk4KaXz9PeiIAybuTbHzbjHkZdz+4XiRhX4lOZQCR2YFJV+2l0e8eTKDCwkzzadVELpd9PP48nBKotaUdV+jyDIr+pSLPqZKQVdnO9yVoPFexWLGIuI10MOegTCIUoidNN6UiD1rc2Z5pCm9NQ1jEOYjKfPucKmF5TVQJhzhov+wld4E251Z5y36/YujvxLXDK4NdoVhBh/Rj4vjv/WmCMBiwejyXiy+shVI1sbo2T9vUZdZXh43ipckkvccJZNGj8PqA/BJSCE1gFiOmEVzCR4D7ZhDdh9ophF+g6n4+dCz0MFRoG3y80CNDVT4OZh9QA68hg9BSkNAjfak5X3ckVgyrmlyjFTMV+77Vh0fik2a3352zysKAHN+0FlK6PW4mtCmixwL5doMG5R15zwmkWN4ptDnuCMG6VQu4E2BXSz6Tz0DNAmnoLJUdZd2NOu26wpoIS/MAEfFj+xIAP1VjBd4QXD4XaywjN38QdBlEFthy3W9NE8D39222FtrOpmGe4XJUE/jLKef/qh27yWrAwCrZXg++f2Vi+Wu4tW5502G8200TAP9bKpkUzfpVFk2bakrhrH03H263j6Zjp6OVnL7WbyY/JzsptkyYvkZfIqeZ0cJXzwcfBp8Pfgn+v/DX8Y/jR81KcOrq1rvk82vuHu/1L/2X4=</latexit>

start with no-wind coordinated turn condition


g
˙= tan
Vg
g
Add and subtract Vg to get

g g
˙= + (tan )
Vg Vg
g g
= + d
Vg Vg

where d = tan is an input disturbance


The associated transfer function is
g/Vg
(s) = ( (s) + d (s))
s

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 15
Lateral Transfer Functions - Sideslip
No-wind conditions: v = Va sin
<latexit sha1_base64="FK1MDrAs5g3Z4B0efbBTZJJHBnQ=">AAAHWnicjVRRj+M0EM4t5XrnA24XeOPFogvaY2+rJuIAIVU6aV94QgfL7h2qS+U4TmJtYmdtp1Xly0/hFX4TEj+GSZpNm+7CkRdPZsbfjD9/nrDIhLGTyV8PDt4bvP9w+OgxevLBhx89PTz6+MqoUjN+yVSm9JuQGp4JyS+tsBl/U2hO8zDjr8Pr8zr+esm1EUr+YtcFn+c0kSIWjFpwLY4Gh0QqISMuLXIkjPGP6mwF/5gpGYk6x3xfYZKagjLuJuPgBcsrfLycXi0oMUKSkFt6jBBZ3mb4kID2QM8BxlJpMRXaFJxH92GSSFm3rPAUn9TgTJkG/Fnjb8yqVyh4IeRupYsyNMBAaYVMcKx0h3iMY61ybFOOo7WkuWAGJ2LJDQLUREiXl5mtCfyqQv9aGtoqVme6xKc4aRIAzm4oKFKBCEGnmMSaMkd0qjDA/Bbgi8oFJKfGVCTjsZ2h84X7dTGpAKSxWmwgo15vvUXVIoW4AACA6jboLoR0F0ItVsQzSxcNXGtu62wcehvTiGiRpHaOCJfRLgUXKlv2KWzJxxR0kWhVFnXYcp13PM5Qn6oz2p5t4W8P1/mCbRfgjhaNF5E5WqVc89tboZlIJPSzC/XlFGN81ud5y3J3cdU+vTc3JY3aBe32McXvBrtLIUHRLXjd0gbCr9yueCp88h+CeYZP3134ftH8L3lgvRe6Tx59CbR8Lw5Hk/Gk+fBdw2+Nkdd+rxZHBz5cPitzeIQsgwPM/Elh545qK1jG4YmWhsObvaYJn2XcgnAKWnD9HOdUw0VP/TG85LlLuMq51ev+BjDhyXIzd82wq/AX4IkaccYKJkrj3d3haG7MOg8hM6c2Nfux2nlfbFba+Lu5E7IoLZdsUyguM2wVricnjoTmzGZrMCjTMBsZZikFtuFAgCT5iqk8hzfiSBHxahbMXXvFRU0FzUagkM4Oqqq/J+Ixv4EEGJTsWvPMEasFlQkw6Kb7yc1MqRc4ROzy/bCGPZtoGLqfq/2wVDqvZj70VwuMvB35GyGQt1WfrSxRcNAUJubzzt7DoqHZQnVIfaCZVJLPXbouUrhMWyEEIvP3JXXXuArG/jfj4Kdg9PLrVm6PvM+8z70Tz/e+9V56P3ivvEuPDVaD3wd/DP58+PfwYPh4+GSTevCg3fOJ1/uGn/4DriGKkw==</latexit>

Constant airspeed: v̇ = (Va cos ) ˙

Substituting for v̇ from the dynamics gives

(Va cos ) ˙ = pw ru + g cos ✓ sin



⇢Va2 S bp br
+ C Y0 + C Y + C Yp + C Yr + CY a + CY r
2m 2Va 2Va a r

Solving for ˙ and grouping terms gives


˙= a +a r +d
1 2

where
⇢Va S ⇢Va S
a 1 = C Y a 2 = CY r
2m cos 2m cos

1 ⇢Va S bp br
d = (pw ru + g cos ✓ sin ) + C Y0 + C Yp + C Yr + CY a
Va cos 2m cos 2Va 2Va a

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 16
Equations of Motion

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 17
Sideslip Dynamics
The di↵erential equation
<latexit sha1_base64="/buQoYxd+6EjVSEKki6ZE3fQ30I=">AAACtHicbVFNa9tAEF2pX6n65bS5lZalplAoNZIOSS6BQC89phAnAcuI1WpkL95dKbujFiN071/sn+hv6Fg2BScdEJp97y1v3mzRaOUxjn8H4YOHjx4/OXgaPXv+4uWr0eHrK1+3TsJU1rp2N4XwoJWFKSrUcNM4EKbQcF2svm746x/gvKrtJa4bmBuxsKpSUiBB+ehXlNla2RIsRpdL4KWqKnB0UkJzuG0HWZTNoqysscsKQNHzM/5F5NtDnvR8aPhn/g9LCStBU+cILvOtIMrmkQZReo41R/IqdC1X5CgWTph8NI4n8VD8fpPsmjHb1UV+GBzRTLI1NKzUwvtZEjc474RDJTX0UdZ6aIRciQV0w6J6/pGgkle1o88iH9A9nTDer01BSiNw6e9yG/B/3KzF6nTeKdu0CFZujapWD0lp6xTSgUS93qSVTtGEXC6FExLpbegJ4KesjRG27DJDUfrNjzyqzvT9Pl1CBbfEeyRrB7rL0ClhF5S4OyMx7TG5u7X7zVU6SY4n6fd0fJ7uNnrA3rIP7BNL2Ak7Z9/YBZsyyf4ER8G74H14HGahDGErDYPdnTdsr0L7F4GS1T8=</latexit>

˙= a +a r +d
1 2

leads to the block diagram

<latexit sha1_base64="+yTiuwCjWQK+6GVcdF69nWd4KPo=">AAADX3icdVLRbtMwFHUaYFuA0QEviBeLCjQ0rUoiBLxMmrQXHoeg3VBdRY7jJNYcJ9gOU2X5Q/gaXuETeORPcNOMqR2zZOXonnN8rm+cNpwpHYa/vYF/5+69re2d4P6Dh7uPhnuPp6puJaETUvNanqdYUc4EnWimOT1vJMVVyulZenGy5M++UalYLT7rRUPnFS4EyxnB2pWSPS/GiUEp1TiJLHx1BHcOUS4xMUiWNZwmGH6yJkYVVsrCk8R86dXWQoSCf964897q7I0Z5U4rV97s6qRrZ2SN81m431weyhYewAKRWiFdOhlSTKCmZK8Pbk1BnOZ6FnRhoXX2DjW2Pz2FjZN2AT0lrym5QV012120hwGSrCj1PBmOwnHYLXgTRD0YgX6duik/RVlN2ooKTbhrdRaFjZ4bLDUjnNoAtYo2mFzggprun1r40pUymNfSbaFhV13T4UqpRZU6ZYV1qTa5ZfF/3KzV+fu5YaJpNRVkFZS3HOoaLh8IzJikRPOFA5hI5jqEpMRuSto9owAJeknqqsIiM6upLz8uIzeVtet0RnP61fFKu2hJuUFaMiwKd2Nz5MRujtHm1G6CaTyO3o7jj29Gx3E/0W3wHLwA+yAC78Ax+ABOwQQQ77v3w/vp/Rr88bf8XX+4kg683vMErC3/2V9/wBOg</latexit>

⇢Va S
a 1
= CY
2m
⇢Va S
a 2= CY r
2m 
1 ⇢Va S bp br
d = (pw ru + g cos ✓ sin ) + C Y0 + C Yp + C Yr + CY a
Va 2m 2Va 2Va a

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 18
Longitudinal Transfer Functions - Pitch
<latexit sha1_base64="Lp+nYRnmLIVJTowiloNWvCP0kU4=">AAAH93iczVVLb9NAEDYFkhJeLRy5jGhBKVWiJIjCBQkJJBAnKmip1G2tzXrtrGqv7d11UWRZgl/CDXHl5/AXuHNn/EgTJ4EKcWElS+N5zzezO8PIF9r0et8vrFy8dLnRXL3Sunrt+o2ba+u39nWYKMb3WOiH6mBINfeF5HtGGJ8fRIrTYOjz98OT57n8/SlXWoTynRlH/CignhSuYNQgy16//IPIUEiHS9N6F4LDlTjlYEb4KSq1yxW4iWS5MrgqDID7/JSaUIEJIRKGjYBKz+ctMuSekCn1hScfZC3AQ5zQpAR9GZrB/acAMWGhJtFIQAcU0UIWNCGFdu2gdgzbELcnFp3+1vlGxOEujwtLx64i2/2sRbh0zjJ7IVysCusVCIH0MH0HdDLUCF5SMDaLvONssyw4x8IZSxoIpsFDdPRCrcSpV1pW/5IGAbV32up40ImOB1uwPct/BJEq/reBuIqylKhRCPs2PR4Ag7dZOnhtjzPic9cczpX63E4DO+1lWY2/XfEJ9aMRzTIoiaU6cS4uojKIMVQe9zfeHO4jiDw3qMiaHlHCG5mjvIocAyebwT1v0v8CRrvMqkO8PODWeahMMEG7mdZ2zqaqZt/Plvv7d+ygKLn9B0xgmnsJ6Fz+ZYyt2l1slUD/1jVMfM8P1MTXGQR/42UGjLOcpqBUnki6ZFRK/W515++TOE6oU+p3/2qOMKUio5lBqo9PZ6HkYlxqsmVTUnttzm9tISTYu8kF6dCafPY16cBUNsgq7NHvlPtwOl4FGs6Mfu3ps9c2et1ecWCR6FfEhlWdN/baT0yFJQE+lsynWh/2e5E5SqkygvkcnSeaR5SdUI+nxSrK4B6yHHBxP7ihNFBwa3o00HocDFEzoGak52U5c5nsMDHuk6NUyCgxXLIykJv4+RrK9xo4QnFm/DESlCmBGQIbUWyTwe3XIpJ/YCG2EtEot0SWEm3Qt+I+wqVEscWy9ClOAuLUn0dlkdgfdPs73cHuYONZr0Js1bpj3bXaVt96bD2zXllvrD2LNXYbHxofG5+a4+bn5pfm11J15UJlc9uqnea3XyAGdeY=</latexit>

To derive the transfer function from elevator to pitch angle

✓˙ = q cos r sin
= q + q(cos 1) r sin
4
= q + d ✓1

Di↵erentiating and substituting q̇ from the dynamics gives


2

⇢V cS cq
✓¨ = 6 (r2 p2 ) + 5 pr + a C m0 + C m↵ ↵ + C mq + Cm e e + d˙✓1
2Jy 2Va

⇢Va2 cS c ˙
= 6 (r 2 2
p ) + 5 pr + Cm0 + Cm↵ (✓ ) + Cmq (✓ d✓1 ) + Cm e e + d˙✓1
2Jy 2Va
✓ 2 ◆ ✓ 2 ◆ ✓ 2 ◆
⇢Va cS c ⇢V cS ⇢V cS
= C mq ✓˙ + a
C m↵ ✓ + a
Cm e e + 6 (r2 p2 )
2Jy 2Va 2Jy 2Jy

⇢Va2 cS c
+ 5 pr + C m0 C m↵ C mq d✓ + d˙✓1
Jy 2Va 1
= a✓ ✓˙ a✓ ✓ + a✓ e + d✓
1 2 3 2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 19
Equations of Motion

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 20
Longitudinal Transfer Functions - Pitch
The di↵erential equation model is
<latexit sha1_base64="vl60f3P8tUiOSAFkkY8nP9XRI10=">AAAEpnicbVLNbtNAEHZKgGL+GjhyWREhpWob2UECLpEqceGECmraSrEJ6/U4XnV/3N01VeT66XgKHoErvADjJEqTlL14PN/MN9/8JIXg1gXBr9bOvfb9Bw93H/mPnzx99nyv8+LM6tIwGDEttLlIqAXBFYwcdwIuCgNUJgLOk8uPDX7+A4zlWp26WQGxpFPFM86oQ9ek04oipblKQTlymgNJeZaBwT9OBYGrch5GpE5BEG79aOyTKE21qyKXg6M1GfqEHNHJ8n8S1oivwUfkFhsgNrfIwZr3bZMBAi0gB0iWrsX7Uexfc5cTaq1mnDpIiTNUWdRIslKxRl0japHRs/tkSCIBmetFmaGsWi9TV/bbYKN0WFssuS4QtRg+zd3+kmUlraE+IAvSsN7k9dclY+CSAsVP9rpBP5g/ctcIl0bXW76TSWcnxPGxUuIGmMCux2FQuLiixnEmAAdSWigou6RTGAtwDkxBCzCHRFIz5Wo46AdcxdUUtARnZpsJaCoqwcbV/HBq8gY9Kck0DlPjAcy96xkVldbOZIKRkrrcbmON83/YuHTZh7jiqigdKLYolJWCOE2aK8QzM8CcmKFBmeHYHGE5xeFiQ8ik4JppKalKq6hIoR4P4mox+6hoRkFFF5ewsnFvmzkpZHCFAdahHgMC12M4VVOcYDXcDpY45rr5YBNZJbdhgzkLNEmqr/U2rLSR9ThEfc3BRDfdcLH+6KbenJaYamw0l5wdruwtLprYW6oV0ybRWGkFcZXPihyX6WrfxyMLt0/qrnE26Ifv+oMvg+5xsDy3Xe+V99rreaH33jv2Pnkn3shjrZ+t360/rb/tXvtze9Q+X4TutJY5L72N1/7+D79xkwI=</latexit>

✓¨ = a✓1 ✓˙ a ✓2 ✓ + a ✓3 e + d ✓2

with associated transfer function


✓ ◆✓ ◆
a ✓3 1
✓(s) = e (s) + d✓ (s)
s 2 + a ✓1 s + a ✓2 a ✓3 2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 21
Longitudinal TF - Altitude from Pitch
To derive the transfer function from pitch to altitude
<latexit sha1_base64="tswxnYioJmeDLSmx4eIIEolI3LM=">AAAFRXicrVNLb9NAEHZDeJlXC0cuKyJQCiWKcwAulZC4cCyoLylrRev12F51H2Z33SoyvnOFP8Vv4EdwQ1w4wDiJAknLAYmVLI/nm/lmZ+ZzUkrh/HD4ZaNzqXv5ytVr18MbN2/dvrO5dffQmcpyOOBGGnucMAdSaDjwwks4Li0wlUg4Sk5etfjRKVgnjN730xJixXItMsGZR9dka+MH1UboFLQn+4akYMUpEF/gY5l2GViSVZq3wSSzRpFSeF4QbwiTWK5KgfSZc5USOifcaOcZMjFhXQmQboc0gVzomkmR68dNSFPj66Ihj3ZJRZ3QFCt5Rp6S09lXWQjKjVt6z2ZfK94Q7+tZTigNkeRwwhbBT0h/lXEJbf+NPvwn+nRShBR0uuzlrAALIR2HiBCaQgbv/tcd4nAfN4BzNVwwD+kFyxCuLV303TbZJTSzjNdYraldQyVkvr+89xyLmhncdkGtyAuPq4knm73hYDg75LwRLYxesDh7k61OhBvklUK5cIn3G0fD0sc1s15wCbjfykHJ+AnLYSzBe7AlK8HuEMUs6mB3NHgudFznYBR4O11NQFMzBS6uZ7puyEP0pCQz2LZBVc28f2bUTDk3VQlGKuYLt461zouwceWzF3EtdFl50HxeKKtkK+v2JyGpsMC9nKLBuBXYHOEFwzliQ8ik4YwbpRiKgZYpNONRXM/HTMt2FEz2cN5Le9Q0qzkzrWAA/iz8xIKsqbeC6RwnWO+uByscc9O+sImsVuuwxZw5miT122Yd1saqZhzh/VpV0Pe9aL5++r5ZnZbMDTZaKMF3lvYaF0vcb6ol0yrRWBsNcV1MywKX6ZswRJFF65I6bxyOBtGzwejNqPdyuJDbteB+8CDoB1HwPHgZvA72goOAd5LOh87Hzqfu5+7X7rfu93loZ2ORcy9YOd2fvwB6FM7R</latexit>

(assuming constant airspeed)

ḣ = u sin ✓ v sin cos ✓ w cos cos ✓


= Va ✓ + (u sin ✓ Va ✓) v sin cos ✓ w cos cos ✓
= Va ✓ + dh

where
4
dh = (u sin ✓ Va ✓) v sin cos ✓ w cos cos ✓

The associated transfer function is


✓ ◆
Va 1
h(s) = ✓+ dh
s Va


<latexit sha1_base64="LpABsBiLXlAhFGC4jZM9bu9puJM=">AAACEXicbVDLSsNAFJ34Nr6qLt0Ei+CqJEXUjVhw47KCtYIpMpnctEMnkzhzo5SQjxBX6pd0J279Aj/EvZPWTVsPDBzOOTNz7wlSwTW67rc1N7+wuLS8smqvrW9sblW2d250kikGLZaIRN0GVIPgElrIUcBtqoDGgYB20L8o/fYjKM0TeY2DFDox7UoecUbRSG0fe4DUvq9U3Zo7gjNLvD9SPR++lnhr3ld+/DBhWQwSmaBa33luip2cKuRMQGH7mYaUsj7tQj4asnAOjBQ6UaLMkeiM1IkcjbUexIFJxhR7etorxf+8uwyj007OZZohSDb+KMqEg4lTbuyEXAFDMTCEMsXNhA7rUUUZml5sX8ITS+KYyjD3Q4jgoch9jeZtBSL3UXEqu2al/Kwoyp686VZmyU295h3X6ldutXFExlghe2SfHBKPnJAGuSRN0iKM9MkzeSPv1os1tD6sz3F0zvq7s0smYH39Agh2ou0=</latexit>

<latexit sha1_base64="Z3YFrZtsiQem+JsXOtHTyQj2R80=">AAACRXicbZDLahRBFIarEy9Je5vEZVwUBkEIDN0T1LgIBtzoLoKTBNKT5nT16Zki1dVt1WnDUNSz+B7uxZ2ufQh36lZrZgIhiT8U/PWfU5fzFa2SlpLkR7S0fOPmrdsrq/Gdu/fuP+itrR/YpjMCh6JRjTkqwKKSGockSeFRaxDqQuFhcfp6Vj/8iMbKRr+naYujGsZaVlIAhSjvvcwqA8JB7jKaIEG+7b2zJwO+xS+y1Fu+FV/sB97zOO9tJv1kLn7dpOdmc6//6O3nk2ev9vPe76xsRFejJqHA2uM0aWnkwJAUCn2cdRZbEKcwRjcfzPMnISp51ZiwNPF5eqkPamundRE6a6CJvVqbhf+rHXdU7Yyc1G1HqMXioapTnBo+o8RLaVCQmgYDwsjwQy4mEEhRYBlnGs9EU9egS5eVWOEH7zJL4W6DKkAyEvQ4jOR2vZ9xSq9SuW4OBv30eX/wLgBL2EIrbIM9Zk9Zyl6wPfaG7bMhE+wT+8K+se/R1+hn9Cv6s2hdis7PPGSXFP39B5tWtNs=</latexit>

a ✓3
s 2 + a ✓ 1 s + a ✓2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 22
Equations of Motion

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 23
Longitudinal Transfer Functions - Airspeed
Both pitch angle and throttle strongly a↵ect airspeed. We wish to derive the
<latexit sha1_base64="FHwgptnIbamM8rRDWEsQxzSk++Y=">AAAHanictVVRjxs1EN4WLikLhWsrgVBfRhxUCddESSQKL5Uq2gd4K2ovVylOV47Xu2t117tnexOdVpb4jbzxC3jhRzD2bu5y6VXokLCUzXg8883MZ3u8qnKhzWTy563bH3180Ovf+ST89LO7n39xeO/+XJe1YvyElXmp3qyo5rmQ/MQIk/M3leK0WOX8dPXuuVs/XXOlRSlfm/OKLwuaSpEIRg2qonsHvxPJN6wsCirjhhRUa+v+TKaTprA2DEMiSyFjLg38XJoMKmFYBlSmOcdvDCZTpcG4oI0qUXsONEk4M0CF0hXn8RjglMNG6AxMCTFXYs3Ri4Piuc9CZ6Iau0BrXVHGm/HsB1Zcjfxr4jwUB6FBlggm48dOIwFCsgjnEYWnQPSZMk39dgbHsPbfzduZDckyfCEwJYVAAgPKFFJMQTtHEpemmduoodYBuFltCSs1oXmVUS+tuKFw3JquLdFCdqrWftOq9uzDa9Cu80BdHDXzaOrz3LgaXV6dDnMadTCD6egCfbiDOQo7zKsGuwH2M3eRXtUrjcel9nQkqiz8jsTnkhaC6S1BK54K2dBcpPJ7e4WsR09BAdK+w9UFMSOo/NIlLZdL6Z4DRvXspnsker2XqkwAHgRDU0IekbOaxnBMEkVZQ1RWukC41a9sM2sPL5CcJ2YBo+dR88IOWsgh5uTmUdPOLZpt6fP6M9tCsjMEcpj20iPmuaERt3YrAVEizcwydNx6t6ntrs7rqBp0ZuaxwxmGOxvcVREieT7LwR6F1zDnIw0vt27kiRq0/Iwuqruev+2RQAqHsBP+hixGE/v/8Pff6WtpICnFvnXDQsIPFAIfLCT8t0LgJgfBdSSOvXZ7q6LDo8l44ge8L0w74Sjoxsvo8A+8iKwusJ2xHGMtppPKLBuqjGA5R/Rac+yj72jKFyjijeZ62finwsJ3qIkhKRX+sK967a5HQwutz4sVWvpHYH/NKa9bW9Qm+WnZCFnVhkvWBkrq3LV89+5ALBQ+Cvg6xIIyJTBXYBlFzgy+To6E6X7J7wvz2Xj6ZDz5bXb0bNLRcSd4GHwTDIJp8GPwLPgleBmcBOzgr97d3pe9r3p/9+/3v+4/bE1v3+p8HgRXRv/bfwAx934K</latexit>

relationship.
If there is no wind, then p
Va = u2 + v 2 + w 2
Di↵erentiating gives

V̇a = u̇ cos ↵ cos + v̇ sin + ẇ sin ↵ cos = u̇ cos ↵ + ẇ sin ↵ + dV1

where
d V1 = u̇(1 cos ) cos ↵ ẇ(1 cos ) sin ↵ + v̇ sin
Substituting from the dynamics gives

V̇a = rVa cos ↵ sin pVa sin ↵ sin g cos ↵ sin ✓ + g sin ↵ cos ✓ cos

⇢Va2 S cq 1
+ CD (↵) CD↵ ↵ CDq CD e e + Tp ( t , Va ) + dV1
2m 2Va m
= (rVa cos ↵ pVa sin ↵) sin g sin(✓ ↵) g sin ↵ cos ✓(1 cos )

⇢Va2 S cq 1
+ C D0 C D↵ ↵ C Dq CD e e + Tp ( t , Va ) + dV1
2m 2Va m

⇢Va2 S cq 1
= g sin + C D0 C D↵ ↵ C Dq CD e e + Tp ( t , Va ) + dV2
2m 2Va m

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 24
Longitudinal Transfer Functions - Airspeed

⇢Va2 S
<latexit sha1_base64="z8e2q03m9yfG6zrQj0pKNZuLaPE=">AAAIMHicrVXNjts2ENYmjZ2of9n0mMug3ga79WphO0BTFAgQIDn0mGazTgDTEWiKlolQlJais9gKfKm8Q96hPRW95ik61I9tabdtClSAoNHw48xwvo/kIpMiN6PR73s3bn52q9e/fcf//Isvv/r67v69aZ6uNeNnLJWpfr2gOZdC8TMjjOSvM81pspD81eLtUzf+6h3XuUjVS3OZ8XlCYyWWglGDrnD/1gcy80mUmmIaUguPIYhJLhSJaZJQGJKlpqwgepUCjr+ZwKktJiSheW6BSL40MwiehsWzcGQh8EurIFRmK2oRUBoQQOk/t1Uwdo4hoMy2mRFxaWjIrW0sIFrEKzMHGEI1bWyLKu/LMDusYebYxTnyhxCFWP/E+mTuE5UKFXFl4FQoxsGsRA78fF0uGNBWqXLdohqEggMMcHAMFxwuhJRQDYhfOdBFujZgtEh+goNqJW8IzQ2C3ZyNTcyKm53fegFdh2kcVEUgufFd2xdUF1MbUmw7hgyasMdAzrHeCEpAlcBRU1nBTsYOskxlsXuIresIWgVdjzfX4Kt6XT9NCrGrd8FjoQoqRay+tz5AKZp6CW4ND1A76I4JS/PDusbCBbFB3b7q76i9rGGlI1K4kDtqq9EY+LRhvlbcVnDQFpyLsJtpC+joq4nNG5VdEZlfl5JRbQSVgKKz2z8n3sNWo0ohltZRLV1iYcsvatLQmBCs8MGGgupzJfU/Zm6S/n16v0MtuM0xbVWARAF1G2a8W+Ow8k1sJ0CNfWg7tGFUn3AVbSRxseKad3XS5MGkn8ZuQ+7w+tOkoXb4idT6wX/q778wS/y6R9v1/F+8bYI/LIO3tpEDBDtnUAne7T2Edwejk1H5wFVjXBsDr36eh/t7L3ADs3WCByWTWP9sPMrMvHD1MslxA6xznlH2lsZ8hqaiCc/nRXnhWPgOPREsU40vHrSld3dGQZM8v0wWiEyoWeXdMee8bmy2Nssf54VQ2dpwxapEy7UEPITc7QWR0JwZeYkGZVpgrcBWFBtv8I7Do59fsBQvLuwMySJuZ5N50eZlMN6yMpjgmdGaE/Elx+uJ5Abr0Vyi3LWgKsaGFI+74JJ198FFLIsEh5GFcbfnV43p5GT8w8nol8ngyajm47Z33/vWO/TG3iPvifez99w781jvuPeiN+uR/vv+b/0/+n9W0Bt79ZxvvNbT//gXWiXR6A==</latexit>

cq 1
V˙a = g sin + C D0 C D↵ ↵ C Dq CD e + Tp ( t , Va )+dV2
2m 2Va e
m

Since this equation is nonlinear in Va , we will linearize about trim: ↵⇤ , Va⇤ , ✓⇤ ,


⇤ ⇤
e , t , and let

V̄a = Va Va⇤ , ✓¯ = ✓ ✓⇤ , ¯e = e

e,
¯t = e

t

to get

⇢Va⇤ S ⇥ ⇤ 1 @Tp ⇤ ⇤
V̄˙ a = g cos(✓ ⇤
↵ )✓¯ +

C D0 C D↵ ↵ ⇤ CD ⇤
e + ( , V ) V̄a
m e
m @Va t a
1 @Tp ⇤ ⇤ ¯
+ ( , V ) t + dV
m@ t t a
= aV1 V̄a + aV2 ¯t aV3 ✓¯ + dV

where
⇢Va⇤ S ⇥ ⇤ 1 @Tp ⇤ ⇤
aV1 = C D 0 + C D↵ ↵ ⇤ + C D ⇤
e ( ,V )
m e
m @Va t a
1 @Tp ⇤ ⇤
aV2 = ( ,V )
m@ t t a
aV3 = g cos(✓⇤ ↵⇤ )

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 25
Longitudinal Transfer Functions - Airspeed
The associated transfer function is
<latexit sha1_base64="/uYBXHNDOOQuqAHtTE/ZVBaC2ck=">AAADiXicjVJRa9RAEN5LtNZU7VUffVk8hCu1R3LSWgShUBAfK/SuhcsRNpvJZWmyCbuTkyPkt/iffPPfuMkF0UsF5+nb+WZ2vvl2wyIVGl3358CyHz3ee7L/1Dl49vzF4fDo5VznpeIw43maq7uQaUiFhBkKTOGuUMCyMIXb8P6q4W/XoLTI5Q1uClhmbCVFLDhDkwqOBt99mQsZgUR6kwBlWudcMISIomJSx6BoXEreVFOhHX/h+CFT1bwO2Fgf00/UjxXjlVdX+oQF1Tzw6tpPIcZxe5rWbbkfQYqsDtD0OKe0pd53FCZgqOayExoF8wb4SqwSPHb8peP4a10wDtXkjGe1Of6W+zlXFBOVo1mafgOasDX8U18npq+yL6+VYS7YEcJkRGMzshDIE8rk6j+mnnaL9sc6D+3eH+o4wXDkTtw2aB94HRiRLq6D4Q8/ynmZGYt4ap5z4bkFLiumUPAUascvNRhD79kKFgZKloFeVu1Pqulbk9muGefG4jb7Z0fFMq03WWgqM4aJ3uWa5EPcosT4YlkJWZQIkm8HxWVKMafNt6SRUMAx3RjAuBJGK+UJMx6i+byNCd7uyn0wn06884n7dTq6dDs79slr8oaMiUc+kEvyhVyTGeHWnvXOOrPO7QPbsy/sj9tSa9D1vCJ/hX31Czj/GdA=</latexit>

1
V̄a (s) = aV2 ¯t (s) ¯ + dV (s)
aV3 ✓(s)
s + a V1

For throttle we have Key inputs are pitch angle


aV2
and throttle command
V̄a (s) = ¯t (s) + dV (s)
s + aV1

and for pitch angle we have


aV3 ¯
V̄a (s) = ✓(s) + dV (s)
s + aV1

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 26
Linear State-space Models
<latexit sha1_base64="3d+W9f3wyfgdS2Pe13fQrRMAIBg=">AAAGJHicrVRLb9NAEHbbBIp5tXDkMqKlapsmSiwVEFKk8jj0BAUlLVCn1WY9dla11+7uOk2w/Hf4I1y5IQ5c+C2sHadt0od6YC8ez3zzzcznWXcjn0lVr/+ZmZ0rlW/dnr9j3r13/8HDhcVHuzKMBcU2Df1QfO4SiT7j2FZM+fg5EkiCro973aO3WXyvj0KykLfUMMJOQDzOXEaJ0q7DxbkfNg8Zd5ArM7G7LrwPecZFBEhFFAIexzlUvkrB7smIUEzqNWuTBiks206okkEKTXBXBxvx2rJp2v0xppFhzCn6lmAB0JA7LCO9hvPAJlKNiHNzA+L8eYMa77DP8p7BFWEASpe8tFCXCF2oOagODpKMOp2gtjYZP0/9CU+Ebpp7oHo4JQ4wDgpFICF0wblYHjzWR2naXfQYT4jPPL6uubNJiy5SWGnCWM7q2Cr6Ats2V8Ya62imySiyERfG2hmmMg5Wz1CVMa56mlC9nqXwVIr+TiEjR3xFvmkjd04HbMtMLgItMtR7CBIFQwk4iAjPFhKICGPujBRSIYz2jn3DG8g12eW5ASpgRw4ml8VSnVjkm5VrUHFazKjJtmsfai24QiseKuLlktkkikQ4+J+1c1oHXTyG10Wm7udNEZ4Q+nBhqV6r5wcuGo3CWDKKs3O4OLOt1aRxoBeb+kTK/UY9Up2ECMWoj5o9lqjvwRHxMMl/Mik80y4HXP0d3ZAryL0TOBJIOQy6GhkQ1ZPTscx5WWw/Vu7LTsJ4FCvkdFTIjf1sI7I/FjhMIFX+UBuEZleQAu0RQai+cZqJ4wkNg4BoOTJd032rk9iuDuvXbB7iLzXSM9tK08mcXGIN0DeaHgn0E1vvI+GeliFpToMDrVWaPfQQbhLosNa+Ma30RWPXqjWe16yP1tKWVXyFeeOJ8dRYNRrGC2PL2DZ2jLZBS+ulndKX0tfy9/LP8q/y7xF0dqbIeWxMnPLff44SGng=</latexit>

Nonlinear state equations: ẋ = f (x, u)


Trim condition: ẋ⇤ = f (x⇤ , u⇤ )
Deviation from trim: x̄ = x x⇤

Rewriting the state equation in terms of deviation from trim gives

x̄˙ = ẋ ẋ⇤
= f (x, u) f (x⇤ , u⇤ )
= f (x + x⇤ x⇤ , u + u⇤ u⇤ ) f (x⇤ , u⇤ )
= f (x⇤ + x̄, u⇤ + ū) f (x⇤ , u⇤ )

Using a Taylor series expansion around trim to linearize gives

⇤ ⇤ @f (x⇤ , u⇤ ) @f (x⇤ , u⇤ )
x̄˙ = f (x , u ) + x̄ + ū + H.O.T f (x⇤ , u⇤ )
@x @u
@f (x⇤ , u⇤ ) @f (x⇤ , u⇤ )
⇡ x̄ + ū
@x @u
4
= Ax̄ + B ū
Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 27
Lateral State-space Equations
The lateral states and inputs are defined as
<latexit sha1_base64="lkrOgHJ+iL82fyrLSa6sRGf2rZI=">AAAJvnicxZbfb9s2EMeVdptr7Ueb7nEvhyUrksUJbLdY9xIgaB+2xwZL0g6mI9ASZROVKJqk7AQE/7L9JXvs6/ZP7CjLdpzaRTN0GAFb59Md9eV9LB4HMuPatNt/bt27/9nnXzQeNMMvv/r6m4ePth9f6KJUMTuPi6xQbwZUs4wLdm64ydgbqRjNBxl7PXj70t9/PWFK80KcmWvJ+jkdCp7ymBp0RduNMyIKLhImDJyNGGTUMEUz0AYNDVQkwIUsDZqKQcJSfE4CVIekF5KkMPbKRZYYdmUspjoHBGPYGPYmLdlSLSJHHL8037/EqEI6CMl4XNIkLNen4TUzNKKt2lDzxJD0Qy9QFMKvlSpgOI9fhIYihbzwphcZkgEbcmFpxofiRxcCjkrpxMGTY5DTQ1XCAQxJXGhiRsxQornwQqtQPw6ApIrGlqhRAUSPlbHlZfdggp/pZdfBb852SU61dnXgAB1ov+DD3mISP15G9vcIFy1XvAczv3KgFn6f21/+EoWhQyAEnsCsXvVlvcS9G+r2b6jbIKjt1smxWDdDPQpDxaU97DiSsdTszZ4zcXZZCF8ERxQfjsz++qlqijOwlfmhOLWMu1URLMESoKwAAvmF5jmNOiDHcDj/1YWxuhO/BTp0bIQnN8CTa+D5p860PIXTSM7/yaZ1EdH9f0G242WtwwuDTWJt261BKz8dWvmRaOVd0aoKbV2/5ytkO/8JWbWBrPog2Wf/D1m1gaz6dGTVR5JVdyXrN9bZeytxhvF8r/V6Z7svelW1F696V+fQ9RzLfM3iNfkLb0iYSBY9YDpi2L2mDEZ0wqDU2MJ2q8rB8R0rt1u1xF0k71PnIahhUn370N0wjB7ttI/a1YD3jU5t7AT1eBVtb53iSuMyxz4cZ7h39zptafqWKsPjjGH3Q9GSxm/pkPXQFDRnum+r/u/gh2pFaaHwg3288t7MsDTX+jofYGROzUjfvued6+71SpP+3LfVAYCJePagtMzAFOAPE5BwxWKTXaNBY8VRK8QjigXEQwTOJNg0LvC9QRJEJsz1un1bv7/Sr4xmO/guLGys8mpOdSbwJAzqUSzDk4DiVAyxIPb4dnDV8fwFF5Ha3DmE0Lld8veNi+5R56ej9ml356Rd43gQfBd8H+wFneB5cBL8GrwKzoO48UfjXeOvxt/Nk2bazJvFLPTeVp3zbbAymlf/ALya/6s=</latexit>

4 4
ẋlat = (v, p, r, , )> ulat = ( a , r)
>

The nonlinear equations of motion are


p
⇢ u2 + v 2 + w 2 S b h i
v̇ = pw ru + g cos ✓ sin + C Y p + C Yr r
2m 2✓ p ◆
⇢(u2 + v 2 + w2 )S h 1 v i
+ CY0 + CY tan p + CY a a + CY r r
2m u2 + w 2
p
⇢ u 2 + v 2 + w 2 S b2 h i
ṗ = 1 pq 2 qr + C p p p + C p r r + 3 Q p ( t , Va )
2 2 ✓ ◆
1 h v i
2 2 2 1
+ ⇢(u + v + w )Sb Cp0 + Cp tan p + Cp a a + Cp r r
2 u2 + w 2
p
⇢ u 2 + v 2 + w 2 S b2 h i
ṙ = 7 pq 1 qr + Crp p + Crr r + 4 Qp ( t , Va )
2 2 ✓ ◆
1 h v i
2 2 2 1
+ ⇢(u + v + w )Sb Cr0 + Cr tan p + Cr a a + Cr r r
2 u2 + w 2
˙ = p + q sin tan ✓ + r cos tan ✓
˙ = q sin sec ✓ + r cos sec ✓
⇣ ⌘ p
where we have used = tan 1 p v and Va = u2 + v 2 + w 2
u2 +w2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 28
Jacobian Matrices
<latexit sha1_base64="pWgh/80AObcqXjIpADn3tbsW49o=">AAAGlHiclZTPjtMwEMbTJYSl/NuCxIWLRQWCy6qpEHBgpYUVEie0ILq7UlNVjuO01jqJsZ3Syso78DRc4TV4GyZtKKR1KrBUdfLNfPk545FDwZnSvd7P1t4V96p3bf96+8bNW7fvHHTunqksl4QOSMYzeRFiRTlL6UAzzemFkBQnIafn4eVJmT+fUalYln7SC0FHCZ6kLGYEa5DGHffp67EJNJ1rw7EuCvT4CAUioiauyYWZ158RlIV0wlIjEqwlmxdttDIGUabNDBwzeNmWKGyitImBmDK7rkAPglpC2HjCxhM2nmjgiSaetPGkjSdtPNnAk028ZbEFWelb1ErfAle6jb1OWfGqAa8a8KoBr5rxao0vEzSN1qNVbufNv41p/t9jGkSUazzG1llb5aR13pqMYpdR7jDKXcbfx9PgradtdrXbrmz22iGMD7q9w95yoe3Ar4KuU63Tcaf1EV5O8oSmmnCs1NDvCT0yWGpGOC3aQa6owOQST+gQwhQnVI3M8lIr0CNQIhRnEn6pRkv1b4fBiVKLJIRK2OFUbeZK0ZYb5jp+OTIsFbmmKVmB4pwjnaHyhkQRk5RovoAAE8lgr4hMscREwz3aDlL6hWRJgqE1Zf+KYX9kghjS8Fh+GeZdv/gT94ui7oloTD9DgdKwH0k5zKtkOJ1AQ8zRZnECXSvKP/iI2CSQhlPwN3u+HZz1D/3nh70Pz7rH/eo89p0HzkPnieM7L5xj551z6gwc4n51v7nf3R/efe+Vd+K9XZXutSrPPae2vPe/AJmHTDU=</latexit>

0 @ v̇ @ v̇ @ v̇ @ v̇
1
@ v̇
@v @p @r @ @
B @ ṗ @ ṗ @ ṗ @ ṗ @ ṗ C
B @v @p @r @ @ C
@flat B @ ṙ @ ṙ @ ṙ @ ṙ @ ṙ C
Alat = =B
B @v˙ @p @r @ @ C C
@xlat B@ @˙ @˙ @˙ @˙C
@ @v @p @r @ @ A
@ ˙ @ ˙ @ ˙ @ ˙ @ ˙
@v @p @r @ @
0 @ v̇ @ v̇
1
@ a @ r
B @ ṗ @ ṗ C
B@ a @ rC
@flat B @ ṙ @ ṙ C
Blat = = B@ a C
@ulat B ˙ @ rC
B@ @˙ C
@@ a @ rA
@ ˙ @ ˙
@ a @ r

Take partial derivatives and evaluate them at trim state and trim input

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 29
<latexit sha1_base64="jTSBobSpeGiRkKxvmcKD44FxAwk=">AAAO4nicpVfJbuNGEOU420R2NPbklOTSiB0jgBdIQjDOxcAgA0xysI3JYo/HaploUi2RMDcVm1YMpk+55Rbkmh/LL+QrUmwu4iZAkQmIrq7ldVfVa7lkBI4dil7vnycb773/wYcfPf24s7n1SffZ9s7zq9CPwOSXpu/4cG2wkDu2xy+FLRx+HQBnruHwt8bdq8T+9p5DaPveL+Ih4COXTT17YptMoErf2fydDjvU4FPbiwOXCbB/lR069kVMDQZxJCWhtKSY1xWzuoIKiwtW11qZgnvjYh9y2iGkvjfB51qPyD6+5+o9w/fRlJp+mELfxpSFQqK2l0AmATcq4EYF3OQBoe0tDThXAecq4FwF9MrmHn72s3c/k0vmNuij9gPukyhbNu0HCmye29vOmxSoXLJmq9Iuqdqm/SnE2ULMelKsrWYzOgcN7KQRMR1zRzCdS9WLfClkWoubqkNWofNWbVLO4lmqXS3jFF7qfJFiphG1tOiok0MIhrdCDi1jlGtM7gkOsuQQOQxkbJqYn/ADiBzeOWPowxw83GsfXHSglFDXHivj3jv9fo/sq07u0QkwM6Zg+eRnYpD7rJEy/oa45Cpb6UzS7+zpkLzS43d6IElQ8CFVgSSQqxLPkQI/IBX0BTZ1WRimnsNOXkgF1JPFOoPGu5jdTWPBs6ZT2jvlp8Ti5MtcoeEKmevSBCrnkfEgTyOcgYizO0MGSVHmxULupdePJmUPirLPy4lUtlnUPGmI6oPM617GggLrKFoDDCpgi/q1EeOqyCbBWSReL30bIqyPCGXEs6WcvR1UWNvG2aDJ2WA5Z+t3ocnToMHTYBWeBqvzNHgMT43qibC8q5P0rERS+j1zXab3yWxFgt0OsAMyr3gZtMTWDHWwFipUUP8PbRP6D2SjDW1wq3C2Da5C2IvHEBaahIXHEBYahIVVCAurExYeTVhYj7AXTcKerEEtqBD2ooWw61wDqBD2Yk3CQjthL9YkLFQJq6YRXwjfVdOBGkXyqSJdFSNHZsKJpKNv7/aOe+ohTaGfCbta9rzRdzZe42htRi6CmQ5+2w/7vUCMYgbCNhNEGoU8YOYdm/KhwwXuGLCAwyFxGeCkczo4PrG9UTzlvssFPFQDUPSYy8NRrH5fSPIVasZk4gN+PEGUthwRMzcMH1wDPXHsssK6LVG22YaRmHw7im0viAT3zHSjSeQQ4ZPkxwoZ28BN4TygwEywMTliWgybggkhksfnpo90wkrSYIyj3WAUZz0LklIwZ7cvFzJSvRoz5hM+Q4dQ4HmAOzgng828KVYwPq07q3+qyR9MYhK7dTNgTGo1jPgnWTd7ODrKYR/P5/CJoL/t9inYUwslWa2WM/UxUcu1zcNCrmExI1xAFUhVoKHne3wUWw+Bhc0U1U0M378TCUrCvH6dZ03hanDcf3E8+HGw+/Iw4+BT7QvtS+1rra+daC+1H7Q32qVmbv67tb312dbn3XH3j+6f3b9S140nWcynWuXp/v0fNXvUXA==</latexit>

0˙1 0
Lateral State-space Equations 10 1 0 1
ū Xu Xw Xq g cos ✓⇤ 0 ū Xe Xt
Bw̄˙ C B Zu Zw Zq g sin ✓⇤ C B C B
0C Bw̄C B Z e 0 C ✓ ◆
B ˙C B C ¯e
B q̄ C = B Mu Mw Mq 0 0C B C B 0 C
B ˙C B C B q̄ C+BM e C ¯
@ ✓¯ A @ 0 0 1 0 0A @ ✓¯ A @ 0 0 A t
h̄˙ sin ✓⇤ cos ✓⇤ u cos ✓ + w⇤ sin ✓⇤
⇤ ⇤
0 0 h̄ 0 0

Lateral Formula

h i ⇤
h i ⇢SCY p
⇢Sbv ⇤ ⇤ ⇢Sv ⇤ ⇤ ⇤
Yv 4mVa⇤ C Yp p + C Yr r + m C Y0 + C Y + CY a a + CY r r + 2m u⇤2 + w⇤2
⇤ ⇢V ⇤ Sb
Yp
dimensional stabilityw derivatives
+ 4m C Yp
a

⇢V Sb
Yr u⇤ + 4m a
C Yr
⇤2
⇢Va S
Ya 2m CY a
⇢Va⇤2 S
Yr h i h 2m CY r i
⇢Sb2 v ⇤ ⇤ ⇤ ⇤ ⇤ ⇤ ⇤ ⇢SbCp p
Lv 4Va⇤ Cpp p + Cpr r + ⇢Sbv Cp0 + Cp + Cp a a + Cp r r + 2 u⇤2 + w⇤2
⇢Va⇤ Sb2

Lp 1q +4 Cpp
⇢Va⇤ Sb2

Lr 2q + 4 Cpr
⇢Va⇤2 Sb
La 2 Cp a
⇢Va⇤2 Sb
Lr h i h 2 Cp r i
⇢Sb2 v ⇤ ⇢SbCr p
Nv 4Va⇤ C r p p⇤ + C r r r ⇤ + ⇢Sbv ⇤ Cr0 + Cr ⇤ + Cr a a⇤ + Cr r

r + 2 u⇤2 + w⇤2
⇤ ⇢Va⇤ Sb2
Np 7q + 4⇤ 2Crp
⇤ ⇢Va Sb
Nr 1q + 4 C rr
⇤2
⇢Va Sb
Na 2 Cr a
⇢Va⇤2 Sb
Nr 2 Cr r

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 30
Alternative Form - Lateral

The lateral dynamics are often expressed using instead of v. Recall that
<latexit sha1_base64="8677ReMiJb2b5JaxBWY2trhin6A=">AAAIiHiclVVdb9MwFM0GlBI+B48IyWJjQkJMaR/4eJg0AQ88oAqmbYDqUrnOTWstcTLbKauivPFreIU/w7/hxs3aNN3KcNXUvTnn+N7ra99BEgptPO/P2vqVq9ca15s33Ju3bt+5e2/j/pGOU8XhkMdhrL4MmIZQSDg0woTwJVHAokEInwfHb4v3n8egtIjlgZkk0IvYUIpAcGbQ1N9oPKIyFtIHacjBCEjIDCgWEn8iWSS4JkwBiQMDksApKmsNPkm1kEOyRQdg2BYRUhtgPqLI1nhrh5B94CwMiRkx49KuOya75KjPKJIsw6U9F5dSEMSoXSDogKlsnBe4bxll2uQI57G28NJCLMha8kLhnQgC1JBGYCTozVCMQVsxPzZZBVzI0kAxnrXy7GL9vEIc53npJGFaxxyXwKi1wR+iE8aBwElqE2jzMw0BhkJmScSMEqf5OV5QWjEmdYOqG2gyEss2fWYD6c8WI7suIXUHCI6v/THZLoP/2k9Wh0/KMSeo/yMMLcSM5hhrwDjOKKvkUMYrIisUP6DfKyphGwGJfSrLqjA7/fFKYscSO8tEzwbSmoaz6DY1TC6EVYn85PxIV1EoxQd+Zqbn6oxVnJDLidT89qr6NVc08ItUkgu8X0G5vPcrRAp3Fyp4+fjMT44t9+mZmU3VfGrPSeWfFssHxH22tACZVXlGfQgN67PV9ekuHI0zkvpHUdtd+lBZw5btnD0FdBYBnSWARypjtvt16yWzaqXR23nSSouqZQ2vwP69TW/Hs4MsT1rlZNMpx8f+xto+3lc8jfBm5iHent2Wl5hexpQRPAQUTTXgFXrMhtDFKXYZ0L3MNrKcPEmL9oJ9Ab/YkKy1yshYpPUkGiASnRzp+rvCeN67bmqCV71MyCTFTsanCwUp9qiYFF2R+EIBN+EEJ4wrgb4SPmK419gNUUnCdx5HEcPs0MSHvNvuZdNSoEkRGQs3sbnM5u2if1Q5PgRwggBsIfxYQZhRzDCTQ0xItlsHR5i1vPjBIIIswte4C616zpcnR+2d1osd71N7c88r96PpPHQeO0+dlvPS2XPeOx+dQ4c3fjR+Nn41fjfdptd82Xw9ha6vlZwHzsJovvkLGyLU8w==</latexit>

v = Va sin

Therefore
v̄ = Va⇤ cos ⇤¯ Utilizing side-slip angle
instead of lateral velocity
Di↵erentiating gives
¯˙ = 1
v̄˙
Va⇤ cos ⇤

The associated state space equations are


0 Yp Yr g cos ✓ ⇤ cos ⇤ 1
0 1 Yv Va⇤ cos ⇤ Va⇤ cos ⇤ Va⇤ cos ⇤ 0 0 1 0 1
¯˙ B L V ⇤ cos ⇤ ¯ Y a Y r
B p̄˙ C B v a Lp Lr 0 0CC Va⇤ cos ⇤ Va⇤ cos ⇤
B 0C B C B C✓ ◆
C B p̄ C B L a
B C BNv Va cos ⇤ ⇤
B r̄˙ C B Np Nr 0 Lr C ¯a
B C=B 0 1 cos ⇤ tan ✓⇤ q ⇤ cos ⇤ tan ✓⇤ C B r̄ C+B N Nr C
B ¯˙ C B CB C B a C ¯r
@ A B r⇤ sin ⇤ tan ✓⇤ 0C @ ¯A @ 0 0 A
C
¯˙ @ 0 0 cos ⇤ sec ✓⇤ p⇤ cos ⇤ sec ✓⇤ A ¯ 0 0
r⇤ sin ⇤ sec ✓⇤ 0

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 31
Longitudinal State-space Equations
The longitudinal states and inputs are defined as
<latexit sha1_base64="JrPpgDXQaOuarLDR7Pezod7/ngE=">AAAIPnicxVVNb9tGEKXTRkrYj8TtsZdB7QZyLRkUEbRFAAMBfCl6SuvYMayV2NVySW5NLr+WYYwF/1v+Q075A70VvfbY4ZJWLEVAUaRAFxA0mJ3ZnffecmaZxaJUjvN2585HH98dDO/dtz/59LPPHzzc/eK8TKuC8TOWxmlxsaQlj4XkZ0qomF9kBafJMuYvllcn7f6Ll7woRSqfq+uMzxMaShEIRhW6vN27b4hMhfS5VPbziEOcylCoyheSxlAqqngJVPogZFYpNAsOPg/wMh9oaZOZTfxU6VeNp4nir5TG/KYhGMLzUTWGegz5GIiKuKJjiA4WGJZmDdgkzyvq29VaHnSJMML/WFGPj6G31E2mTeamTpnKFjItgONBLZYS0gCStDXbMm2y5KGQmsYilN82NuAytVYNPDqGSV7DBEJSCtlVZwLadQgkKCjTpIhSGFUL97BeuAdw2miXJLQsscqYB2q2SmjXiacvPKdZ8x12Xk1onEW0RaeoXOjJtDEHjLpr6gYrIoUII3WwPb3noqPHmGtxXe585UM9FQ0JgUcdx9BTvRUfKfMCKelANi3Ixz3I7vK8aRjk23NPb7TLChSmWfFzsu7fYKvDfnWja4984U5WVNsbyIAQm8R0yWPN8yed6hN8L5Ma5bwlbG2EzSusMiQsLf8jXS+36nr5Ybpe/p+6Xhpd4baw5gLyjsvccNmfOEWKfvKumw3mGJxuYcxwlnjaabawlnwYa8m/Z83krmA8XsHYJKg/vn3vC3eDmDVmulfV0ZOv7UTGWb1rKTCp4dZDJFz6q3ZURxxbac0hoi85VCX20/2OGjj+Z2r27bYn7597JvoGCpLUgtm3vYd7zpFjFrxvTHtjz+rXM2935xeEwKoExwCL8Z3Mpk6m5poWSrCYY9fFCjPKrmjIZ2hKmvByrs34aeAbU36QFviTCoz3doamSVleJ0uMTKiKys291rltb1ap4Ie5NqOHS9ZdFFQxqBTaWQa+KDhT8TUalBUCawUWUSRL4cSzieQ1S5MEqdIk83kzc+e6/0ayFhmN9/BNrGwXX+xajhlGGIBjkF0V2H6IKgSVIRKijzeDzdfV/iGIQCe4jSpMNzl/3zh3j6bfHTk/u3tPnV6Pe9ZX1tfWyJpa31tPrR+tZ9aZxQZPBr8OxOC34evh78M/hn92oXd2+pwvrbU1/OtvD+eW5Q==</latexit>

4 4
ẋlon = (u, w, q, ✓, h)> ulon = ( e , t )>

The nonlinear equations of motion are

⇢(u2 + w2 )S h ⇣ ⌘
1 w
i
u̇ = qw g sin ✓ + CX0 + CX↵ tan + CX e e
p 2m u
⇢ u2 + w 2 S ⇢Sprop h i
2 2 2
+ CXq cq + Cprop (k t ) (u + w )
4m 2m
⇢(u2 + w2 )S h ⇣ ⌘
1 w
i
ẇ = qu + g cos ✓ + CZ0 + CZ↵ tan + CZ e e
p 2m u
⇢ u2 + w 2 S
+ CZq cq
4m
1 h ⇣ ⌘ i 1 p 2
2 2 1 w
q̇ = ⇢(u + w )cS Cm0 + Cm↵ tan + Cm e e + ⇢ u + w2 SCmq c2 q
2Jy u 4Jy
✓˙ = q
ḣ = u sin ✓ w cos ✓

1 w
p
where we have used ↵ = tan u and Va = u2 + w 2

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 32
Jacobian Matrices
<latexit sha1_base64="H1tuV7gs7kPNYDhdeREDWPm39D4=">AAAGiHiclVRdb9MwFE1HCKN8rfCIkCwqEE9VUk0MHiaN8cLjQHSb1FSV49w01hznyyGtrLzxa3iFP8O/wWmrjjRuBZai3Jxzj8/N9ZW9hNFc2PbvzsEd86517/B+98HDR4+fHPWeXuZxkREYkZjF2bWHc2CUw0hQweA6yQBHHoMr7+ZjzV99gyynMf8qFglMIjzjNKAECwVNe+aLD1PpCpgLyWJeVej1KXITH2TQgCs5b34jlebBjHKZRFhkdF510Uro+rGQhVIUarMWWOrAVAe6IgSBdUxYIddtoKXOrtTZlTq7cqddqbVLdXapzi7V2aU77VKt3TpX47lhWsYbpuW+YfQlbOh2HaGuhFDnHuqMw52e4dKuhoD7m4Gq7c//bTiL/x5O1wcm8BS0k7fihHbMdgnLfcJ0jzDdJ7w9rB3q7YT2FuEedagRNo5getS3B/ZyoXbgrIO+sV4X017ni9qZFBFwQRjO87FjJ2IicSYoYVB13SKHBJMbPIOxCjmOIJ/I5UVWoVcK8VEQZ+rhAi3RvxUSR3m+iDyVqSoM822uBnXcuBDBu4mkPCkEcLIyCgqGRIzqWxH5NAMi2EIFmGRU1YpIiDNMhLo7uy6HksRRhFVr6uZV4+FEuoGi1Wf9Z5j1neo2HlZVU+NDAKlKyIWqJwOmji2jmM9UQ+TpdnKkulbVL/UTgYwUrU7B2e55O7gcDpy3A/vzcf9suD6PQ+O58dJ4YzjGiXFmfDIujJFBzO/mD/On+cvqWrZ1Yr1fpR501ppnRmNZ538AqKFHQw==</latexit>

0 @ u̇ @ u̇ @ u̇ @ u̇
1
@ u̇
@u @w @q @✓ @h
B @ ẇ @ ẇ @ ẇ @ ẇ @ ẇ C
B @u @w @q @✓ @h C
@flon B @ q̇ @ q̇ @ q̇ @ q̇ @ q̇ C
Alon = =B
B @u˙ @w @q @✓ @h C
C
@xlon B @✓ @✓ ˙ @ ✓˙ @ ✓˙ @ ✓˙ C
@ @u @w @q @✓ @h A
@ ḣ @ ḣ @ ḣ @ ḣ @ ḣ
@u @w @q @✓ @h
0 @ u̇ @ u̇ 1
@ e @ t
B @ ẇ @ ẇ C
@flon B@ e @ tC
B @ q̇ @ q̇ C
Blon = = B@ e @ tC
@ulon B @ ✓˙ @ ✓˙ C
@@ e @ t
A
@ ḣ @ ḣ
@ e @ t

Take partial derivatives and evaluate them at trim state and trim input

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 33
Longitudinal State-space Equations
<latexit sha1_base64="uUssq9oq7YUd17jNxBY5RFPjBVw=">AAAPknicvVfrbuNEFPaWyy4hkC3wjz8jWiqkNlUSVixCqrSo0gqhjbRc2q2SyUZjZxJb9djOeEw2mp0X4Wn4C2/A23Ds8T1ukiKEpTjjc+Z8c853vnEmZuA6oej1/n5w8M67773/8NEHrQ/bH33ceXz4yXXoR9yiV5bv+vzGJCF1HY9eCUe49CbglDDTpa/M28vY/+o3ykPH934V64BOGFl4ztyxiADT9LD9NR63sEkXjicDRgR33qgWnvlCYpNwGSmFMC4ZVnXDsm7AwqaC1K12aqDeLF8HXbQQqq+N4LqZRugE7qvkvoR7d4EtP9TQryUmoVBg7cWQccAoCRglAaMsIHS8OwOGScAwCRgmAb2yuwefk/TeT8cldxN0tznBExSlj5v+0wRslfmb8o0JKlO22SrdpYRb3Z98uCyGaU/yZ3uzGa3TDey4ERLPqCvIlKqkF9mjUJqLUXVCytCw0RrTmV93WverWMOrKS1KTC2iVhaetDIIQWBXqLE9yQwW9QTlquSPXMKVtCwoT/gBj1zaeuF7C0dEM8cjLiT43OcMZmGMMHNm8Qx0DHo9RidJN4/xnBNL5k3nto9+URIzEoYA6tK5GF9O5c20p6V+ipInTNzAJkp/pbFlf8EngCTDdFLMAHcWtpgk07tIr6/XzbWVgehVlJIDnVC6RCXG0pNBPVkRy/RbySeIoetsZaIaloRFBH0jZMD9QKnL6mOOmBFyrLcTbgGFq5zC7rLKgMZfNVJaYbRgKy10Hz5rdJbZvJOZnNft1NTiq7mVyCh34z50rrbQuSzozLOt5FMkm6W2VBbUsQlVkFVTeRkHDUpIJXrz6poQRSMiVJ0UGGPpwe3rQU32Am0WPSptw0YJNe/KXEKjXEKjnRIa7Smh7oYEStilBjZtyGq6OhZ6VNIcKymuzMOqRuuOvfNfFY62bJ5a5c3ir8Tksk13Xlw82qP4QvnRXsJPcJuUP7q38kc7lD/c/kMRV6rkj9N12poYkuW9YTt7w/btTXfzvcaaZRkn0/guhB2ZRJV6UvT0CYQ1dme4Q5rofyLgdDsB0b8jYLUPAcstUtJCKkFrpEr8vTRpbbCSlpQjYtMXwmfJUSc5OWWnIP2UH5FSFxygWq3p46PeeS+50Oagnw6OjPR6OT08eA5/BayIAZrlwp4Y93uBmEjChWPFkDgKaUCsW7KgY5cKWDIgAeVniBEOR7OLwflTx5vIBfUZFXxdDYChRxgNJzL5P6TQl2CZobnP4eMJlFjLEZKwMFwzE2bCMdEO677Y2OQbR2L+7UQ6XhAJ6ll6oXnkIuGj+M8VmjmcWsJdw4BY3IHikGUTaA4UBEgeXVk+YwSoxMEMjqKDiUx7F8RUEPeor4rxQKlqzIzO6RImhALy4dSF0wB3iLcABuVFfXLy6om/oIi5ZHU3hxjtNU35s6q7PTjmqnEf8os3In571NfbB79VVbbchQ+F2syxzvJxDYuYYQGVI1WBxp7v0Ym014ENzRTVRUzfvxUxSqy8fl1nm4PrwXn/m/PBT4OjZ2epBh8ZnxtfGF8ZfeOp8cz4wXhpXBlW+/f2H+0/2391Put81/m+c6mnHjxIYz41KlfnxT+O/Eew</latexit>

0˙1 0 10 1 0 1
ū Xu Xw Xq g cos ✓⇤ 0 ū Xe Xt
Bw̄˙ C B Zu Zw Zq g sin ✓⇤ 0C Bw̄C B Z e 0 C ✓ ◆
B ˙C B CB C B C ¯e
B q̄ C = B Mu Mw Mq 0 0C B C B 0 C
B ˙C B C B q̄ C+BM e C ¯
@ ✓¯ A @ 0 0 1 0 0A @ ✓¯ A @ 0 0 A t
h̄˙ sin ✓⇤ cos ✓⇤ u cos ✓ + w⇤ sin ✓⇤
⇤ ⇤
0 0 h̄ 0 0

Longitudinal Formula
u⇤ ⇢S
⇥ ⇤ ⇤
⇤ ⇢Sw⇤ CX ⇢ScCXq u⇤ q ⇤ ⇢Sprop Cprop u⇤
Xu m C X 0
+ C X ↵
↵ + C X e e 2m

+ 4mVa ⇤ m
⇤ w⇤ ⇢S
⇥ ⇤ ⇤
⇤ ⇢ScCXq w⇤ q⇤ ⇢SCX↵ u⇤ ⇢Sprop Cprop w⇤
Xw q + m CX0 + CX↵ ↵ + CX e e + 4mVa⇤ + 2m m

⇢V SC c
w⇤ + a X q
Xq 4m
⇢Va⇤2 SCX
X e 2m
e

⇢Sprop Cprop k2 t⇤
X t
dimensional stability derivatives
u⇤ ⇢S
⇥ m ⇤ ⇢SCZ w⇤ u⇤ ⇢SCZq cq ⇤
Zu q + m CZ0 + CZ↵ ↵ + CZ e e⇤
⇤ ⇤
2m

+ 4mVa⇤
w⇤ ⇢S
⇥ ⇤ ⇤
⇤ ⇢SC Z u ⇤ ⇢w ⇤
ScC Zq q

Zw m C Z 0
+ C Z ↵
↵ + C Z e e
+ 2m

+ 4mVa ⇤

⇤ ⇢Va⇤ SCZq c
Zq u + 4m
⇢Va⇤2 SCZ
Z e 2m
e

u⇤ ⇢Sc
⇥ ⇤ ⇤
⇤ ⇢ScCm↵ w⇤ ⇢Sc2 Cmq q ⇤ u⇤
Mu Jy C m0 + C m↵ ↵ + C m e e 2Jy + 4Jy Va⇤

w ⇢Sc
⇥ ⇤ ⇤
⇤ ⇢ScC m↵ u ⇤ ⇢Sc 2
Cmq q ⇤ w⇤
Mw Jy C m 0 + C m ↵ ↵ + C m e e
+ 2Jy + 4Jy Va⇤
⇤ 2
⇢Va Sc Cmq
Mq 4Jy
⇢Va⇤2 ScCm
M e 2Jy
e

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 34
Alternative Form – Longitudinal
The longitudinal dynamics are often expressed using ↵ instead of w. Recall that

w = Va sin ↵ cos .

At trim, when = 0 we have

w̄ = Va⇤ cos ↵⇤ ↵
¯.
Utilizing angle of attack
Di↵erentiating gives instead of downward velocity
1
¯˙ =
↵ ˙
w̄.
Va⇤ cos ↵⇤
The associated state space equations are
0 ˙1 0 10 1 0 1
ū Xu Xw Va⇤ cos ↵⇤ Xq g cos ✓⇤ 0 ū Xe Xt
B↵¯˙ C B Zu Zq g sin ✓ ⇤ B ¯ C B ⇤Z e ⇤
B ˙ C B Va⇤ cos ↵⇤ Zw Va⇤ cos ↵⇤ Va⇤ cos ↵⇤ 0CC B↵ C B Va cos ↵ 0 C ✓ ◆
C ¯e
B q̄ C = B M Mw Va⇤ cos ↵⇤ 0C B C
C B q̄ B 0 C
B ˙C B u Mq 0 C+B M e C ¯t
@ ✓¯A @ 0 0 1 0 0A @ ✓¯A @ 0 0 A
˙h̄ sin ✓⇤ Va cos ✓⇤ cos ↵⇤

0 u cos ✓ + w⇤ sin ✓⇤
⇤ ⇤
0 h̄ 0 0

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 35
Reduced Order Modes
Longitudinal Modes
• Short-period Mode
• Short-period mode is the fast mode seen in pitch rate q and pitch angle
• Phugoid Mode
• Phugoid mode is slow mode seen in pitch angle and u
• Induced by impulse on elevator

Lateral Modes
• Roll Mode
• First order fast mode between aileron and roll rate
• Spiral-divergence Mode
• First order (really) slow mode between aileron and yaw/course
• Dutch-roll Mode
• Second order mode: coupling between roll, yaw, and side slip. Like a
duck wagging its tail
• Induced by doublet on aileron or rudder

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 36
Simulation Project

• Find trim states and inputs. For the aerosonde model use Va = 17 m/s,
and R = 150 m.
• Find the transfer functions derived in this chapter.
• Find the state space models derived in this chapter.

• Compute the eigenvalues of Alon and Alat and associate them with the
phugoid mode, the short period mode, the roll mode, the dutch roll mode,
and the spiral mode. Show these modes in the simulator.

Beard & McLain, “Small Unmanned Aircraft,” Princeton University Press, 2012 Chapter 5: Slide 37

You might also like