Physics system working. About to unravel the Mesh class into a maintainable form