#include "StdAfx.h"
#include "Contact.h"
#include "./RigidBody.h"
#include <MathLabs/utilities.h>
#include <algorithm>