【发布时间】:2020-03-11 16:41:30
【问题描述】:
我正在处理有障碍物的配置空间中的路径规划问题。我用一个势场对其进行建模,其中障碍物是从表面出现的峰。我想插入这些峰值,以便更平滑地表示障碍物。我尝试使用 scipy griddata 函数,但它给了我这个:(见第二张图片)。请问有人有想法吗?
这是我的代码:
#map
nx = 40
ny = 40
x = np.linspace(0,5,nx)
y = np.linspace(0,5,ny)
X,Y = np.meshgrid(x,y)
#data to plot
U = np.zeros((nx,ny))
points = []
for i in range(nx):
for j in range(ny):
U[i][j] = potential(X[i][j],Y[i][j],gx,gy,obstacle,mu)
points.append([i,j])
#interpolation
xnew ,ynew = np.linspace(0,5,2*nx), np.linspace(0,5,2*ny)
Xnew, Ynew = np.meshgrid(xnew,ynew)
values = np.reshape(U,(1600,))
Z = griddata(points, values, (Xnew, Ynew), method='linear')
#plot
fig = plt.figure()
ax = fig.gca(projection='3d')
surf = ax.plot_surface(Xnew, Ynew, Z, cmap=cm.coolwarm,linewidth=0, antialiased=False)
fig2 = plt.figure()
ax = fig2.gca(projection='3d')
surf = ax.plot_surface(X, Y, U, cmap=cm.coolwarm,linewidth=0, antialiased=False)
fig.colorbar(surf, shrink=0.5, aspect=5)
plt.show()
【问题讨论】:
标签: python numpy multidimensional-array scipy 3d