+ Re-implement MATLAB code
+ Have not been tested with actual data

- Two other kind of Pseudo-Inverse method calculation have not implemented yet