Reverse engineered the mean and covariance functions from matlab in order to import matlab GPR models for higher accuracy. Also fixed a bug in the pose detection in phasespace - the problem was that the rotation matrices were being formed incorrectly (vertical axis stacking vs horizonal)