Add motion correction test functions

WIP moco using 2D cross correlation