Added contact sensor simulation + more deterministic contact simulation