Continued work on Kalman

Josh Leverette's picture

I continued working on and looking into the Kalman filters tonight. Also of interest, apparently the CMSIS provides some basic matrix math functions, which was a pleasant surprise, and I plan to use them, if I can get them working.