re-organised Configurator. It still fails for some cases, something to do with not being able to init an ASVConfig
PRMGraph doesn't generate points as close to the obstacles now (about 0.001-0.005 units is as close as possible)
gave ASVConfig a masscenter() method