Fix rotation matrix bug found by Alex
Merge pull request #28 from yosefm/fix_rotation

Fix rotation matrix bug found by Alex