Commit #2

Simulation base coding done, Equation done, Coord done, model and
implementing Affine Transform next,
Matrix bug fix

Implementation of rotation matrix and bug fix on function generation