Create CalcMotionMatrix.m