Added Matrix4d.invert() and toString()
Even more matrix tests