一种复杂环境下的行人移动轨迹在线预测方法及系统与流程

1.本发明属于智能交通领域，尤其涉及一种复杂环境下的行人移动轨迹在线预测方法及系统。


背景技术：

2.随着计算机技术、传感器技术、人工智能和5g通讯技术的迅速发展，智能交通系统和智能化移动设备的应用逐渐普及。自动驾驶汽车安装了大量传感器，能够实时探测到周围一定范围内的行人。准确的行人轨迹预测对自动驾驶系统至关重要，它可以帮助系统在车辆行驶过程中正确地进行决策，如刹车、减速、转弯或直行。目前，行人轨迹预测模型以离线模型为主，即模型建立或者训练好之后就固定不变，离线模型不会随新的输入数据动态调整。然而，行人移动的随机性大、动态性强，离线模型因此很难应对实时动态预测的需求。


技术实现要素：

3.为了解决上述技术问题，本发明的目的是提供一种复杂环境下的行人移动轨迹在线预测方法及系统，提高轨迹预测的准确率，降低智能移动设备与周围行人碰撞的风险。
4.本发明所采用的第一技术方案是：一种复杂环境下的行人移动轨迹在线预测方法，包括以下步骤：
5.基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹；
6.根据行人历史轨迹提取行人多维度移动特征；
7.基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型；
8.动态更新轨迹预测模型的参数并基于轨迹预测模型预测行人未来时刻的轨迹；
9.所述行人多维度移动特征包括位置特征、速度特征、加速度特征和阻力特征。
10.进一步，所述基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹这一步骤，其具体包括：
11.基于智能移动设备探测一定时间内的行人位置数据；
12.以t＝{(x1，y1，t1),,...,(x
i
，y
i
，t
i
),...,(x
n
，y
n
，t
n
)}三元组集合的形式表达每一个行人在一段时间内的运动轨迹，得到行人历史数据。
13.进一步，所述根据行人历史轨迹提取行人多维度移动特征这一步骤，其具体包括：
14.根据行人历史轨迹提取位置特征、速度特征、加速度特征和阻力特征；
15.所述位置特征包括行人当前位置的x坐标、行人当前位置的y坐标和对应的时刻t，所述速度特征包括行人当前运动速度大小和行人当前运动速度方向，所述加速度特征包括行人加速度大小和行人加速度方向，所述阻力特征包括行人运动阻力大小和行人运动阻力方向；
16.根据位置特征中相邻位置点的距离和时间间隔计算行人运动速度大小；
17.根据位置特征中相邻位置点的偏移计算行人运动速度方向；
18.根据相邻位置点的行人运动速度大小和时间间隔计算行人运动加速度大小；
19.根据行人运动速度大小和行人运动速度方向计算行人运动加速度方向；
20.根据可视域内其他行人及障碍物与当前行人的距离计算行人运动阻力大小和行人运动阻力方向。
21.进一步，所述行人运动速度大小的计算公式如下：
[0022][0023]
上式中，v(n)
value
为目标行人在n时刻的运动速度大小，(x
n
,y
n
)为目标行人在n时刻的位置，(x
n
‑1,y
n
‑1)为目标行人在n
‑
1时刻的位置，δt为行人连续两个位置点间的时间间隔。
[0024]
进一步，所述行人运动速度方向的计算公式如下：
[0025][0026]
上式中，v(n)
direction
表示目标行人在n时刻运动速度方向。
[0027]
进一步，所述行人运动加速度大小的计算公式如下：
[0028][0029]
上式中，a(n)
value
表示目标行人在n时刻的运动加速度大小，v(x)
n
和v(y)
n
分别为目标行人在n时刻的运动速度沿x轴和y轴方向的速度分量，v(x)
n
‑1和v(y)
n
‑1分别为目标行人在n
‑
1时刻的运动速度沿x轴和y轴方向的速度分量，sgn为符号函数，取值{
‑
1,0,1}。
[0030]
进一步，所述行人运动加速度方向的计算公式如下：
[0031][0032]
上式中，a(n)
direction
表示目标行人在n时刻的运动加速度方向。
[0033]
进一步，所述基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型这一步骤，其具体包括：
[0034]
以行人多维度移动特征为特征集，行人历史轨迹中下一时刻位置为结果集，对支持向量回归模型进行训练，建立特征集和结果集之间的映射关系，并预测k 1时刻的行人位置，k表示训练窗口大小；
[0035]
计算每个目标行人在k 1时刻预测位置与真实位置的误差；
[0036]
基于网格搜索法选择最优训练窗口和参数组合，得到轨迹预测模型。
[0037]
本发明所采用的第二技术方案是：一种复杂环境下的行人移动轨迹在线预测系统，包括以下模块：
[0038]
数据获取模块，基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹；
[0039]
特征提取模块，用于根据行人历史轨迹提取行人多维度移动特征；
[0040]
模型训练模块，基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型；
[0041]
预测模块，用于动态更新轨迹预测模型的参数并基于轨迹预测模型预测行人未来时刻的轨迹。
[0042]
本发明方法及系统的有益效果是：本发明不断将行人位置数据输入至模型，动态调整更新预测模型内部参数，从而实现对复杂环境下行人未来轨迹的预测，解决在输入数据的分布特征发生变化时离线预测模型预测效果差、适用性不强的问题。
附图说明
[0043]
图1是本发明一种复杂环境下的行人移动轨迹在线预测方法的步骤流程图；
[0044]
图2是本发明具一种复杂环境下的行人移动轨迹在线预测系统的结构框图；
[0045]
图3是本发明具体实施例行人多维度移动特征提取示意图。
具体实施方式
[0046]
下面结合附图和具体实施例对本发明做进一步的详细说明。对于以下实施例中的步骤编号，其仅为了便于阐述说明而设置，对步骤之间的顺序不做任何限定，实施例中的各步骤的执行顺序均可根据本领域技术人员的理解来进行适应性调整。
[0047]
如图1所示，本发明提供了一种复杂环境下的行人移动轨迹在线预测方法，该方法包括以下步骤：
[0048]
基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹；
[0049]
根据行人历史轨迹提取行人多维度移动特征；
[0050]
基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型；
[0051]
动态更新轨迹预测模型的参数并基于轨迹预测模型预测行人未来时刻的轨迹；
[0052]
所述行人多维度移动特征包括位置特征、速度特征、加速度特征和阻力特征。
[0053]
进一步作为本方法的优选实施例，所述基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹这一步骤，其具体包括：
[0054]
基于智能移动设备探测一定时间内的行人位置数据；
[0055]
以t＝{(x1，y1，t1),...,(x
i
，y
i
，t
i
),...,(x
n
，y
n
，t
n
)}三元组集合的形式表达每一个行人在一段时间内的运动轨迹，得到行人历史数据。
[0056]
进一步作为本方法优选实施例，所述根据行人历史轨迹提取行人多维度移动特征这一步骤，参照图3，其具体包括：
[0057]
根据行人历史轨迹提取位置特征、速度特征、加速度特征和阻力特征；
[0058]
所述位置特征包括行人当前位置的x坐标、行人当前位置的y坐标和对应的时刻t，所述速度特征包括行人当前运动速度大小和行人当前运动速度方向，所述加速度特征包括行人加速度大小和行人加速度方向，所述阻力特征包括行人运动阻力大小和行人运动阻力方向；
[0059]
根据位置特征中相邻位置点的距离和时间间隔计算行人运动速度大小；
[0060]
具体地，所述行人运动速度大小的计算公式如下：
[0061]
[0062]
上式中，v(n)
value
为目标行人在n时刻的运动速度大小，(x
n
,y
n
)为目标行人在n时刻的位置，(x
n
‑1,y
n
‑1)为目标行人在n
‑
1时刻的位置，δt为行人连续两个位置点间的时间间隔。
[0063]
根据位置特征中相邻位置点的偏移计算行人运动速度方向；
[0064]
具体地，所述行人运动速度方向的计算公式如下：
[0065][0066]
上式中，v(n)
value
表示目标行人在n时刻的运动速度大小，(x
n
,y
n
)表示目标行人在n时刻的位置，(x
n
‑1,y
n
‑1)表示目标行人在n
‑
1时刻的位置，δt为行人连续两个位置点间的时间间隔。
[0067]
根据相邻位置点的行人运动速度大小和时间间隔计算行人运动加速度大小；
[0068]
具体地，所述行人运动加速度大小的计算公式如下：
[0069][0070]
上式中，a(n)
value
表示目标行人在n时刻的运动加速度大小，v(x)
n
和v(y)
n
分别为目标行人在n时刻的运动速度沿x轴和y轴方向的速度分量，v(x)
n
‑1和v(y)
n
‑1分别为目标行人在n
‑
1时刻的运动速度沿x轴和y轴方向的速度分量，sgn为符号函数，取值{
‑
1,0，1}。
[0071]
根据行人运动速度大小和行人运动速度方向计算行人运动加速度方向；
[0072]
具体地，所述行人运动加速度方向的计算公式如下：
[0073][0074]
上式中，a(n)
direction
表示目标行人在n时刻的运动加速度方向。
[0075]
根据可视域内其他行人及障碍物与当前行人的距离计算行人运动阻力大小和行人运动阻力方向。
[0076]
行人运动过程中会有一个可视域范围，如图3所示。通常设置为行人前进方向135
°
夹角且半径为10米的范围。在行人a可视域内的其他行人b和障碍物c会对行人a的运动产生阻碍。阻力的大小与行人b和障碍物c到行人a之间的距离密切相关，距离越近，则阻力越强。根据距离的反比来确定阻力的大小，并通过矢量求和得到可视域范围内行人b和障碍物c产生的阻力总和。可以表达为：
[0077][0078]
上式中，neibour(n)
size
为在n时刻行人a的可视域内的全部行人及障碍物对其产生的阻力的大小，为在行人a可视域范围内的其他行人或障碍物i的坐标位置，num为n时刻行人a可视域内的全部行人及障碍物总数。
[0079]
阻力方向的计算公式如下：
[0080]
[0081]
上式中，neibour(n)
direction
为目标行人在n时刻的可视域范围内全部行人及障碍物所产生的阻力的方向。
[0082]
进一步作为本发明优选实施例，所述基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型这一步骤，其具体包括：
[0083]
以行人多维度移动特征为特征集，行人历史轨迹中下一时刻位置为结果集，对支持向量回归模型进行训练，建立特征集和结果集之间的映射关系，并预测k 1时刻的行人位置，k表示训练窗口大小；
[0084]
计算每个目标行人在k 1时刻预测位置与真实位置的误差；
[0085]
基于网格搜索法选择最优训练窗口和参数组合，得到轨迹预测模型。
[0086]
根据已知的有限数据，分别设置不同的窗口大小。假设训练窗口大小为k，则输入的训练数据中特征集为p＝{x
i
,y
i
,t
i
,v
i_value
,v
i_direction
,a
i_value
,a
i_direction
,neibour
i_value
,neibour
i_direction
}，结果集为y＝{x
i 1
,y
i 1
},i＝1,2,3,...,k。对模型进行训练，建立特征集和结果集之间的映射关系，并预测k 1时刻的行人位置。
[0087]
针对每种不同的窗口大小k，计算每个目标行人在k 1时刻和预测位置与其真实位置的误差。选择让该数据集中全部行人的平均位置误差更低的窗口大小值k_best作为最优窗口。平均位置误差是该数据集中每个行人的预测位置与真实位置之间的均方误差，其计算公式为：
[0088][0089]
其中，n为数据集行人总数，为行人i在t时刻的预测位置坐标，为行人i在t时刻的真实位置坐标。
[0090]
设定在线支持向量机模型的参数c、ε、γ的取值范围，利用网格搜索法为轨迹预测模型优选一组预测平均位置误差最小的参数值组合。
[0091]
进一步作为本发明优选实施例，所述动态更新轨迹预测模型的参数并基于轨迹预测模型预测行人未来时刻的轨迹这一步骤，其具体包括：
[0092]
调用训练好的行人轨迹在线预测模型，为每个行人输入由长度为k_best的轨迹序列构建的9个移动特征，输出层为下一个时刻的行人预测位置。假设当前时刻为t，长度为k_best的轨迹序列表示为：
[0093]
s1＝{(x
t
‑
k_best 1
，y
t
‑
k_best 1
,t
t
‑
k_best 1
),...,(x
t
‑1,y
t
‑1,t
t
‑1),(x
t
,y
t
,t
t
)}
[0094]
智能移动设备在行进过程中会连续不断地采集周围的行人位置数据，随着时间推进，新的行人位置数据不断输入进来。当新输入的行人位置数据(x
t 1
,y
t 1
，t
t 1
)作为新样本增加到样本集时，将最早输入的行人位置数据样本删除，以保持训练窗口大小不变，表示为：
[0095]
s2＝{(x
t
‑
k_best 2
，y
t
‑
k_best 2
，t
t
‑
k_best 1 2
)，...，(x
t
，y
t
，t
t
)，(x
t 1
，y
t 1
，t
t 1
)}
[0096]
在线更新机制会根据新的输入数据，调整模型内部参数使得所有样本均满足kkt条件，即原问题与新问题呈强对偶关系。这样在新的输入数据和训练样本数据的分布特征存在明显差异时，也不需要重新训练模型。模型将样本训练集t分为支持集(support集)、保持集(remaining集)和错误集(error集)三个子集。当训练集t中新增样本时，这个新增的样
本会加入上述三个集合中的某一集合中，这样原本三个集合中的样本可能会根据需要发生移动变化，同时模型内部参数θ
j
、q
ij
和b不断更新，从而实现对模型的在线调整，使得在不重新训练模型的情况下对目标行人的轨迹仍能进行有效预测。
[0097]
最后，根据调整后的模型，预测轨迹s2的下一个位置(x
t 2
，y
t 2
)。
[0098]
如图2所示，一种复杂环境下的行人移动轨迹在线预测系统，包括以下模块：
[0099]
数据获取模块，基于智能移动设备探测一定时间内的行人位置数据，得到行人历史轨迹；
[0100]
特征提取模块，用于根据行人历史轨迹提取行人多维度移动特征；
[0101]
模型训练模块，基于行人多维度移动特征和行人历史轨迹训练支持向量回归模型，得到轨迹预测模型；
[0102]
预测模块，用于动态更新轨迹预测模型的参数并基于轨迹预测模型预测行人未来时刻的轨迹。
[0103]
上述系统实施例中的内容均适用于本方法实施例中，本方法实施例所具体实现的功能与上述系统实施例相同，并且达到的有益效果与上述系统实施例所达到的有益效果也相同。
[0104]
以上是对本发明的较佳实施进行了具体说明，但本发明创造并不限于所述实施例，熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换，这些等同的变形或替换均包含在本技术权利要求所限定的范围内。