Contact Modelling for Forward Dynamics of Human Motion