Check the result of all algorithm is correct is the next step, multi_dim_interval_tree is nearly ready.