Fixed rotation matrix to take into Y-Up frame.
Merge pull request #332 from tfili/axis-orientation-fix

Fixed rotation matrix to take into Y-Up frame.