Added C file that implements the MATLAB code. Does not use the GPU yet