Added provision to calculate block position with 3 fiducials.
Fixing fiducial position PSO.
Added functionality to calculate transformation matrices.
Added additional functionality to Matrix class.

Add and also multiply matrix with a constant scalar value.