Understood rotmat, scale etc properly and made some changes. Untested on the rig yet.