Wrote the algorithm, solving the differentian equation and interpolates tign
Updated the algorithm and fixed some bugs, introduced matrix C