add default implementation of RigidBodyTerrain.writeWRL method
fix bug in collisionDetectTerrain.m
Fix varargin usage in contactConstraintsBV