System Identification and Kalman Filter for the closed loop dynamics of a quadrotor

Given and input desired lateral position (y_sp) and a measured output lateral position (y), I use System Identification theory to estimate the lateral dynamics of a quadrotor. I use a Linear Grey-Box Model.

I write a discrete time Linear Kalman Filter to estimate the vehicles lateral velocity, fusing MoCap with IMU.