function pointsInScapulaCoordinates = CT2ScapulaCoordinates(obj,points) if (size(points,2) ~= 3) error('points should be an Nx3 array') pointsInScapulaCoordinates = points; return end origin = obj.scapula.coordSys.origin; xAxis = obj.scapula.coordSys.PA; yAxis = obj.scapula.coordSys.IS; zAxis = obj.scapula.coordSys.ML; scapulaFrame = [xAxis',yAxis',zAxis']; pointsInScapulaCoordinates = (points-origin)*scapulaFrame; end