Centroid

Notes:

Calculate the centroid and slopes for all apertures:
The structure of the return on the function is a row vector of slopes:
[s_x(0,0),.,s_x(0,N),.,s_x(M,0),.,s_x(M,N),s_y(0,0),.,s_y(0,N),.,s_y(M,0),.,s_y(M,N)]

Centroid calculation using thresholding method.

Can you are more to your test? Some print maybe to at least check what the output is. But the best would be to have automatic tests being done. (Where the test checks if the output is as expected.