Added code to manipulate joint position data, plus some actual data
Added mass similarity matrix maker
Added save figure functionality