ICP registration sometimes fails - if initialization is bad

[gattia]

Update ICP registration so that it tests multiple starting positions for registration... or at least give the option for it to do this. This will make for more robust registration.