fixed ICP (using the more up to date code from my ICP library).  Fixed ModelFit.