detrminant and inverse function for 3x3 matrix
right sided multiplication between matrix and vector
simple contact solver is added
rigidbody update
creating physics world