Bugfixes on SDF parser (SDF parser can now simulate a simple box); bugfix to finding contacts for plane primitive