Cleanup as requested:
- using SiStripDetId::TIB instead of the numeric value
- removed the unneeded divisions, changed sqrt with square
- changed uint to float to not risk underflow
- refactored the common code that test for the last hit
RecoHI/HiTracking stays with the basic trajectory filter without cluster shape (at least until they test it)