Merge pull request #17 from RARyan/TavinBranch

Tavin branch
Added the beginnings of ExtendedKalmanFilter(). Most of it is just code
for testing out how the Efficient Java Matrix Library (EJML) handles
matrices and matrix ops.