CN - Add missing atan and sqrt files
CN - Add kalman filter and attitude estimation files. Temporarily using estimation from kalman filter to indicate roll and pitch angles.
CN - split out some code from the attitude_estimation function.
CN - Moved some things around.