added preliminary broadphase and solver