changed rotation matrix definition (bug) in Rotate for positions and origins