first version
Added getTimeToBoundaryCollision
Merge branch 'collidewithboundary'