I also optiized FacePositionCache a bit: I removed a map lookup and vector copy from both branches of getFacePosition.