Still working on Lagrange poly formulation.  Working but wrong.