RRT 绕障

扩展时检查整段边是否撞墙，树不会穿过去。窄通道迫使树先向下再穿门。黄点是当前随机采样。点画布改终点。