narrowphase optimization
SAPBroadphase optimizations