Added in rotation tracking before saving points to matlab