Merge pull request #13 from CirrusMio/rotation_alg

Rotation algorithm implementation
Small fix
rebasing
Works and adding a little functionality
rebasing
Stupid rebase stuff