Batch Informed Trees (BIT*)