Some improvement in the collision function by basing the collide vector on the depth of overlap. Still some annoying artifacts with the long pieces not getting dragged to the center properly.