Finite Difference Algorithm

Moving code over from other git repository