Integrated Kalman into uCOS

Review and comment, please.