Capacity was incorrectly 2x larger than needed. Added unit test to ensure it stays correct.
Max Mesh Position Error
PRAGMA_DISABLE_OPTIMIZATION
PRAGMA_ENABLE_OPTIMIZATION
Function