-
未知放射源的搜寻采用渐进式。首先,将探测器采集剂量值作为粒子滤波的观测值,得到源的估计位置;其次,利用路径规划使得机器人向估计位置前进多个步长;最后,重复上述过程,直到找到放射源。本寻源算法仅适用于单点放射源搜寻,当地图中出现多个放射源时,观测点处的剂量计数值将会相互叠加,可能造成放射源位置存在多种可能,进而造成本文算法失效。
放射源搜寻环境地图如图2所示,其中,图2(a)为真实辐射环境,图2(b)为基于该环境的仿真地图。由于湖泊对于机器人来说是不可通过区域,因此在路径规划中当做障碍物处理。
-
移动机器人的放射源搜寻流程图如图3所示,先对粒子集进行初始化,获取机器人当前位置的观测参数。再进行滤波得到放射源估计位置,并将其位置作为人工势场的目标,且前进n个步长。最后判断当前位置和估计位置之间的距离是否小于距离阈值D,如果小于距离阈值D,则停止放射源搜寻,否则继续上述操作。为保证粒子的多样性,利用高斯分布函数将重采样后的粒子进行自适应更新。机器人通过多次移动和位置估计,粒子的范围将会逐步缩小,机器人将逐步靠近源,直到找到源。
-
粒子滤波最早是由Moral[15]提出,通过不断的发展,也适用于移动机器人渐进式寻源。它对权重大的粒子进行筛选,缩小粒子范围,进而对放射源位置进行估计。粒子滤波算法的关键在于解决粒子多样性缺失的问题,主要通过以下两种方法来解决:(1)通过增加粒子数目的方法来保证粒子多样性,但会使得计算量成倍增加,导致机器人等待时间过长;(2)通过改进重采样方法解决多样性问题,可适用于机器人的寻源策略。本文基于辐射环境,采用高斯分布函数将重采样后的粒子进行自适应更新,以解决上述问题。源位置估计具体步骤如下。
(1)粒子集初始化。利用均匀分布在机器人搜索区域内随机生成N个粒子,其参数为
${R_i}{\rm{ = [}}{x_i}{\rm{ }}{y_i}{\rm{ }}{\phi _i}{{\rm{]}}^T}$ ,其中,${x_i},{y_i},{\phi _i}$ 分别表示粒子二维坐标及剂量计数值。同时,将粒子集表示为$\{ R_0^{{i}},w_k^i\} _{i = 1}^N$ ,$w$ 表示k次观测时第i个粒子的权重,初始化的粒子具有相同的权重,即$\{ R_0^{{i}},\frac{1}{N}\} _{i = 1}^N$ 。粒子的参数向量$R_0^i = {[x_0^i{\rm{ }}y_0^i{\rm{ }}\phi _0^i]^{\rm{T}}}$ 通过均匀分布产生:(2)粒子权重更新。设观测参数为
$G{}_k{\rm{ = [}}{\xi _k}{\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {\zeta _k}{\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} {I_k}{]^{{T}}}$ ,则源的后验概率密度$p(R|G)$ 可用粒子集$\{ R_{0:k}^i,w_k^i\} _{i = 1}^N$ 表示。由于难以从$p(R_{0:k}^i|{G_{1:k}})$ 中进行抽样,因此引入重要性分布函数$q(R_{0:k}^i|{G_{1:k}})$ ,可通过贝叶斯重要性采样和序贯重要性采样抽取样本。贝叶斯采样在获取新观测值时需要重新从分布函数中抽取独立同分布粒子集,将耗费大量资源。而序贯重要性采样将贝叶斯重要性采样写成观测序列,通过递归更新获得权重可获得较好的效果[16]。序贯重要性采样将分布函数分解为即新的采样集与新样本、旧样本有关。又粒子权重可表示为
将式(4)带入式(5)有
又由式(5)可得
联立式(6)和式(7),则
$p(R_k^i|R_{0:k - 1}^i)$ 表示源参数的状态转移过程,假设在整个放射源搜寻过程中源的参数恒定不变,则可取权重可近似为
其中
由式(10)和式(11)可得
将权重进行归一化处理,则
故放射源参数后验概率估计可表示为
其中
$\delta $ 为狄拉克(Dirac)函数。序贯重要性采样虽然能够获得放射源参数估计,但其存在粒子退化问题。在进行若干次迭代之后,粒子会集中于少数粒子上,继续迭代将浪费大量计算资源,同时可能造成估计误差较大,为了抑制粒子退化,引入粒子重采样。(3)粒子重采样。粒子滤波重采样方法遵循优胜劣汰的原则,通过多次复制权值大的粒子、舍弃小权值粒子来抑制粒子退化问题。常见的重采样方法有简单重采样、分层重采样、系统重采样和残差重采样四种,从采样质量和时间复杂度考虑,系统重采样(SR)更优[17]。系统重采样流程如下:
第一步:将区间
$\left( {0,1} \right]$ 均匀划分成M个互补区间,即$\left( {0,1} \right] = \left( {0,\frac{1}{M}} \right] \cup \ldots \cup \left( {\frac{{M{\rm{ - }}1}}{M},\;1} \right]$ ;第二步:对每个独立的子区间同分布采样可得
${\mathop U\limits^{\rm{\sim }} _i}$ ,其中${\mathop U\limits^\sim _i} = \frac{{i - 1}}{M} + U(0,\frac{1}{M}]$ ,其中$U(x,y]$ 表示区间$(x,y]$ 上的均匀分布;第三步:令累积分布函数为
$cdf$ ,满足${I^i} = cdf({u_i})$ 。若将权值集合表示为$\{ {w^i}\} _{i = 1}^N$ ,则${u_i} \in \left(\sum\limits_{j = 0}^{i - 1} {{w^j},} \sum\limits_{j = 0}^i {{w^j}} \right)$ ;第四步:通过循环比较
${I^i}$ 与${\mathop U\limits^\sim _j}$ 的值复制权值大的粒子,得到新的粒子集。(4)放射源参数的估计。在经过重采样之后,权值大的粒子获得了多次复制,粒子将会更多地集中于权值高的区域。源参数的估计值为重采样后粒子参数的期望值,表示为
(5)粒子自适应更新。重采样使得粒子延缓了集中于少数粒子的速度,但其仅复制权值高的粒子,并未进行本质上的粒子更新。因此,粒子在进行多次迭代后依旧会集中于初始权值高的粒子,因此源位置估计精度受到粒子初始化值的影响较大。为了解决这一问题,从而提高粒子滤波的精度和稳定性,引入自适应系统重采样。高斯分布函数具有对称性,易调整其均值和方差,因此将高斯函数作为粒子更新函数。重采样初期与后期粒子参数调整范围不同,随着重采样次数的增加粒子范围将逐步减小,因此需要自适应调整偏差参数。将重采样后权值不为0的粒子作为有效粒子,其最大、最小权值粒子参数用于自适应更新粒子,则新的粒子参数可表示为:
其中:
${N_{{\rm{eff}}}}$ 为重采样中有效粒子的个数(即权值不为0的粒子);$[{\{ x_k^{0:{N_{{\rm{eff}}}}}\} _{\min }},{\{ x_k^{0:{N_{{\rm{eff}}}}}\} _{\max }}]$ ,$[{\{ y_k^{0:{N_{{\rm{eff}}}}}\} _{\min }}, $ $ {\{ y_k^{0:{N_{{\rm{eff}}}}}\} _{\max }}]$ ,$[{\{ \phi _k^{0:{N_{{\rm{eff}}}}}\} _{\min }},{\{ \phi _k^{0:{N_{{\rm{eff}}}}}\} _{\max }}]$ 分别表示第k次重采样后粒子的横纵坐标及剂量值范围。(6)重复步骤(2)至(5),直到机器人的位置与放射源的估计位置小于阈值D (D为常数)时停止搜寻。
-
KHATIB[18]在有障碍物的环境中使用了人工势场法,利用虚拟力的方法规划机器人路径。机器人分别将目标和障碍物作为引力极和斥力极,在矢量合力作用下向前运动。假设机器人的斥力只受其前后左右四个方向的影响,斥力作用点处于障碍物上且为单方向上距离机器人最近的点(同一障碍物可能存在多个斥力作用点),如图4(a)所示。人工势场法的示意图如图4(b)所示。其中:
${F_{{\rm{re}}}}(X)$ 定义为障碍物形成的斥力;${F_{{\rm{at}}}}(X)$ 定义为放射源的估计位置处形成的引力,${F_{{\rm{total}}}}{\rm{(}}X)$ 为排斥力与吸引力的矢量合力。假设机器人在环境中的起始位置为$X{\rm{ = [}}{x_0},{y_0}]$ ,则基于放射源环境下构建引力场可定义为其中:
${K_{{\rm{at}}}}$ 为引力增益系数;${X_{{\rm{goal}}}}$ 为源估计位置;$\rho (X - {X_{{\rm{goal}}}})$ 为机器人与源估计位置的欧氏距离。引力为引力场函数的负梯度,可表示成障碍物给移动机器人施加的斥力场函数可定义为
其中:
${K_{{\rm{re}}}}$ 表示斥力增益系数;$\rho \left( {X - {X_{{\rm{obs}}}}} \right)$ 代表机器人与障碍物斥力点之间的欧氏距离,${\rho _0}$ 表示受到障碍物影响的最大欧氏距离。斥力可定义为假设机器人受到
$N{}_{{\rm{re}}}$ 个斥力点的影响,则机器人受到的合力可表示为人工势场法效果的好坏主要受到引力增益系数和斥力增益系数的影响。引力增益系数过大导致引力远大于来自障碍物的斥力,可能使机器人撞向障碍物;斥力增益系数过大导致斥力远大于引力时,如果放射源与障碍物位置过近,机器人在斥力的影响下将无法靠近放射源。在该辐射环境下进行多次实验,最终参数设定如表1所列。
仿真参数 值/单位 引力增益系数Kat 300 000 斥力增益系数Kre 260 000 斥力影响最大距离ρ0 500 m 障碍物最小安全距离da 1 m 转向角α 20° -
为了验证放射源搜寻的可行性,本实验在Matlab 2016a平台上进行仿真。首先,选用500 m×500 m的平面地图,定义一个放射源。其次,移动机器人搭载辐射剂量计数器采集观测点辐射剂量值,并通过粒子滤波算法估计源参数。然后,利用人工势场规划机器人行进轨迹,并且前进n个步长。最后,不断重复源参数估计与路径规划,直到找到源。
-
设置机器人的起始位置是(50 m, 450 m),放射源的放置位置是(50 m, 50 m),阈值D为2 m,放射源剂量计数值
${\phi _{\rm{s}}}$ 约为180 000 cps,粒子滤波生成的粒子数目N=2 000,本底辐射剂量计数值${\mu _{\rm b}}{\rm{ = 1\,cps}}$ ,辐射探测器的辐射暴露时间${\tau _k} = 5\,{\rm{s}}$ ,设置障碍物的衰减因子${\beta _{{{ks}}}}$ 为0.03。机器人的位置在矩形中心,前进步长定义为矩形中心到下一个矩形中心的长度,因受转向角的影响,因此步长并非定值。图5表示放射源的搜寻过程,经过粒子滤波定位和路径规划之后可得以下结果。机器人在搜寻的过程中需要对观测点进行测量,一般来说,观测点的数目越多粒子滤波效果越好。在开始寻源过程中,由于观测值较少,粒子滤波得到的源估计位置与实际位置相差较大,但其能够提供大致的寻源方向。随着机器人的逐步前进可以获得更多的观测点,位置估计也会变得越来越准确,直到找到源位置。
-
为了进一步研究不同观测值数目对于源定位的影响,在图6研究了不同观测值数目下SR采样算法与自适应SR采样算法对放射源位置定位算法稳定性的影响。其中,横坐标代表观测点的数目,纵坐标表示源估计位置(X和Y方向上的坐标)参数。
从图6可以看出,随着观测点数目的增多,SR采样算法将逐渐向放射源位置(50 m, 50 m)收敛,但算法稳定性较差使得定位波动较大,最终得到的源的估计位置也会受到影响。改进后的粒子滤波加入了粒子自适应更新粒子的思想,在粒子数目不变的前提下保证了粒子的多样性,在经过多次观测值采集后,放射源位置估计总体上会逐渐趋于平缓。
分别对SR采样算法和自适应SR采样算法进行50次模拟,可得到两种算法下的定位误差,如表2所列。根据表2中数据可知,两种算法在X和Y方向上定位的最大误差相对较大,能达到10 m以上,而二者的最小误差相差较小,由此说明自适应SR算法比SR更加稳定。在精度方面,自适应SR算法的平均误差小于SR,表明自适应SR算法受到初始化粒子的影响更小,平均定位精度更高。
参数 最大误差/m 最小误差/m 平均误差/m SR 自适应SR SR 自适应SR SR 自适应SR X方向 12.764 5 3.235 4 1.251 4 0.951 1 6.632 1 1.562 4 Y方向 18.625 4 4.524 1 1.951 4 1.592 4 8.425 4 2.921 4
Search Method of Radioactive Source Based on Particle Filter and Artificial Potential Field
doi: 10.11804/NuclPhysRev.37.2020030
- Received Date: 2020-04-21
- Rev Recd Date: 2020-05-20
- Available Online: 2021-11-22
- Publish Date: 2020-12-20
-
Key words:
- source estimation /
- particle filter algorithm /
- progressive search /
- artificial potential field method /
- system resampling
Abstract: In order to solve the problems of difficulty and low positioning accuracy in the process of radioactive source search, an autonomous source finding method suitable for mobile robot is proposed. In this method, the radiation counting value collected by the mobile robot equipped with the radiation detector is used to establish the radiation attenuation model according to the attenuation law of the gamma ray, and the particle filter algorithm is used to estimate the parameters of the radiation source in real time. The Gaussian distribution function is used to adaptively update the resampled particles to ensure the diversity of the resampled particles. The robot path planning model is established according to the radiation environment, and the artificial potential field law is used to draw the automatic source-seeking path of the robot. Experiments are carried out under matlab, and the results show that the method can find unknown single point source in the occluded environment, and the adaptive updating can improve the stability of the algorithm and reduce the source search error.
Citation: | Cheng ZHANG, Yufeng XIAO, Haojie LIU, Mingsheng WANG. Search Method of Radioactive Source Based on Particle Filter and Artificial Potential Field[J]. Nuclear Physics Review, 2020, 37(4): 867-874. doi: 10.11804/NuclPhysRev.37.2020030 |