Add float rounding routine
Add collision time function
Minor changes
Update collision time function