A Contact Model For Geometrically Accurate Treatment Of Polytopes In Simulation