templatized the ICP class.  Wrote a mex wrapper in matlab and put together a test script.  ICP double precision is now confirmed and the performance in matlab is pretty good.