将搜索历史图改为三维的可以更直观地展示粒子在三维空间中的搜索过程。具体实现如下:
```
% 绘制粒子搜索历史图和权重分布图
figure;
subplot(2,1,1);
for i = 1:N_particles
plot3(squeeze(particles_history(i,:,3)), squeeze(particles_history(i,:,1)), squeeze(particles_history(i,:,2)), 'color', [0.5, 0.5, 0.5], 'linewidth', 1);
hold on;
end
plot3(APD, pred, zeros(size(APD)), 'r-', 'linewidth', 2);
title('粒子搜索历史图');
xlabel('时间');
ylabel('距离');
zlabel('速度');
grid on;
hold off;
subplot(2,1,2);
histogram(particles, 'Normalization', 'probability');
title('权重分布图');
xlabel('距离');
ylabel('概率密度');
grid on;
```
这样就可以同时显示三维的粒子搜索历史图和权重分布图了。