Function for sword position, based on Cartesian control. Correction of a matrix element into reverK.