Fixed transformation order for PointToLocal and PointToWorld, add some tests to make sure they match ToLocal and ToWorld