Added some kalman formulas and the beginning of the quadrocopter model.