Matlab Code for tracking 3d motion of fish