Altitude control w/ Kalman filter

I incorporated a Kalman filter into the altitude control loop; it estimates altitude and velocity from a model of the helicopter and the altitude measurement from the LIDAR Lite. It doesn’t compensate for tilt errors, so it only works for small pitch and roll angles. The dynamics model includes a lag between issuing the thrust command and when the rotor thrust reaches steady state, so a transfer function Tactual/Tcommand = 1/(tau*s + 1) goes between the controller transfer function and the plant. This plot shows a climb to 20 m then a descent at 1 m/s. The black curve is the Kalman filter altitude estimate and the red points are the noisy LIDAR measurements.

kalmanaltitude

This plot shows the commanded control output and the actual control output for tau = 0.9 seconds.

thrust

Advertisements
This entry was posted in Uncategorized. Bookmark the permalink.

Leave a Reply

Fill in your details below or click an icon to log in:

WordPress.com Logo

You are commenting using your WordPress.com account. Log Out / Change )

Twitter picture

You are commenting using your Twitter account. Log Out / Change )

Facebook photo

You are commenting using your Facebook account. Log Out / Change )

Google+ photo

You are commenting using your Google+ account. Log Out / Change )

Connecting to %s