Constraint forces and configuration constraint implemented.