Adding Madgwick's Matlab attitude estimation for reference and testing.
Merge branch 'master' of http://github.com/mlautman/penn