Added inverse dynamics for orientation away from singularities
Merge branch 'gh-pages' of https://github.com/jeljaik/extended-kalman-filter into gh-pages