


障碍物与路线区分度不高,请问有没有什么办法使二者更容易区分开。
number_of_obstacles = 80
function Makemap3D_100(goal1)
Ddata = hcat(rand(number_of_obstacles, 2) .* 1100 , rand(number_of_obstacles, 1) .* 20)
X = Ddata[:,2].*0.1
Y = Ddata[:,1].*0.1
Z = Ddata[:,3].*2
width = 4
height = 4
data_size = 150;#栅格大小
# 创建空白三维矩阵
data = zeros(data_size, data_size, data_size);
#三维地图数据赋值-----建筑物群
for i = 1:1:size(Ddata,1)
global x,y,z,x_end,y_end,z_end
x = Int(clamp(round(X[i]), 1, data_size))
y = Int(clamp(round(Y[i]), 1, data_size))
z = Int(clamp(round(Z[i]), 1, data_size))
x_end = min(x + width, data_size)
y_end = min(y + height, data_size)
z_end = min(z, data_size)
if x_end > x && y_end > y && z_end >= 1
data[y:y_end, x:x_end, 1:z_end] .= 1 #生成障碍物
data[(goal1[end,2]-2):(goal1[end,2]+2), (goal1[end,1]-2):(goal1[end,1]+2), 1:(goal1[end,3]+50)] .= 0.0 #避免终点与障碍物重叠
data[(goal1[1,2]-2):(goal1[1,2]+2), (goal1[1,1]-2):(goal1[1,1]+2), 1:(goal1[1,3]+50)] .= 0.0 #避免起点与障碍物重叠
else
println("Invalid obstacle dimensions at index $i")
end
end
plot3DMap(data)# 绘图
return data
end
function plot3DMap(data)# 根据数据绘制三维地图
f, v = isosurface(data, 0.5)
c = interp1(LinRange(minimum(v[:, 3]), maximum(v[:, 3]), 256), jet(256), v[:, 3])
p = patch(faces=f, vertices=v, facecolor="g", edgecolor="none")
plt_view(0,90) #当前坐标区设置相机视线的方位角和仰角
xlabel("X方向") #设置坐标轴及区间
xlim([0,120])
ylabel("Y方向")
ylim([0,120])
zlabel("Z方向")
zlim([0,60])
end