Having trouble with the integrator stability.  I need to rewrite this over the weekend.