Fixed bugs.  D1 and D2 were reversed from what they were supposed to
be.  And I forgot to add rho into the Linear System to update y.