Added transformation matrices to RigidBody3D