Shoulder kinematics routines for Matlab