added method for printing matrix
fixed identity matrix
fixed DH transformation matrix
fixed matrix multiplication
fixed theta2 calculation
updated IK for left arm
invert matrix method
simple IK calculations