MATLAB 中是否有针对 Simulink 模型的 Monte Carlo 本地化工具?

Is there Monte Carlo localization tool in MATLAB for Simulink model?

下图显示了我想要执行的操作的示例。在具有多边形的环境中使用 Simulink sl_quadrotor 模型,我们称它为塔,我希望四旋翼飞行器沿着塔向上飞行,然后从塔顶飞到塔的另一侧,然后向下飞行。我在图像顶部添加了一些箭头以阐明所需的路径。

在我的实际环境中,我会有很多塔。

我需要使用 Monte Carlo 本地化。

Simulink/MATLAB 中是否有任何可用的工具?

更新 1:

这是 sl_quadrotor 模型,我只是更改要从作品 space 中读取的 x、y、z。

没有任何 pre-built 粒子过滤器(即 Monte-Carlo 定位)算法,但假设您对需要实现的方程有点熟悉,那么就可以做到使用对标准卡尔曼滤波器算法的相当简单的修改,并且在 Simulink 中有大量这样的示例。例如Kalman Filter Design or A simple Kalman Filter in Simulink.