fixed methods for matrix and added new
renamed inverse method for matrices, fixed IK calculations