added gimbal lock support. Fixes #16
Merge branch 'develop' of github.com:erendrake/KOS into develop