Euler rotation matrices fixed, trasnponse matrix function added