Fix moment of inertia for fixed/infinite mass objects. Add rotational component into contact constraint.