Made a yaw pitch roll function to calculate the right matrix for rotations.
The rotations are now calculated with a matrix, and looking better.
Merge branch 'HelmTeam4' of github.com:gametechnology/psi-2013 into HelmTeam4