initialise physics cfm and erp from mars_Simulator config file
bugfix in Joint6DOF