Add correction matrix

The markers on the animal may not always be perfectly position relative to the anatomy
A correction matrix (4x4) can now be used to do that