First cut at a Projected Gauss Seidel solver in an example program. Needs more example systems.
This will evolve into a PGS solver for Simbody.