Added further test cases to evaluate C Code against Matlab simulation.
This is in reference to Issue #19.