Fixed some namings and rotation order of xyz rotation matrix