Fast and reasonable contact force computation in forward dynamics based on momentum-level penetration compensation.