Adding trajectory/box --kazu
Combining DistanceAlgo and IntersectAlgo --kazu