Merge pull request #23 from froj/master

Integrated Kalman into uCOS