Collision-inclusive Planning