Fix to use ContactPoint instead of HardPoint in vehicle computation