[发明专利]一种计算潜在碰撞严重指数的方法、装置和系统有效
申请号: | 202110678719.0 | 申请日: | 2021-06-18 |
公开(公告)号: | CN113401138B | 公开(公告)日: | 2022-05-03 |
发明(设计)人: | 王红;于文浩;李骏 | 申请(专利权)人: | 清华大学 |
主分类号: | B60W60/00 | 分类号: | B60W60/00;B60W40/00;B60W30/08 |
代理公司: | 北京安信方达知识产权代理有限公司 11262 | 代理人: | 蒋冬梅;栗若木 |
地址: | 10008*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 计算 潜在 碰撞 严重 指数 方法 装置 系统 | ||
1.一种计算潜在碰撞严重指数的方法,其特征在于,所述方法包括:
根据预先获取的环境点云确定无人驾驶的第一车辆周围多辆第二车辆的相关信息,其中,所述第二车辆的相关信息包括:该第二车辆相对于所述第一车辆的车速、该第二车辆的航向角、该第二车辆相对于第一车辆的位置和该第二车辆相对于第一车辆的距离;
根据预先获取的第一车辆航向角和多辆第二车辆的相关信息,采用预先设置的潜在碰撞严重指数算法计算潜在碰撞严重指数,包括:
分别根据预先获取的第二车辆的相关信息计算每个第二车辆的碰撞严重度、第一加权系数和第二加权系数;
根据所计算多个第二车辆的碰撞严重度、多个第一加权系数和多个第二加权系数采用预先设置的潜在碰撞严重指数算法,计算出第一车辆的潜在碰撞严重指数
其中,所述分别根据预先获取的第二车辆的相关信息计算每个第二车辆的碰撞严重度、第一加权系数和第二加权系数包括:
如果第一车辆和第二车辆发生碰撞,根据预先获取的第一车辆航向角和第二车辆航向角计算第一车辆与第二车辆的碰撞角;
根据预先设置的拟合公式计算出第二车辆的碰撞角所对应的碰撞严重度;
根据第一车辆航向角和第二车辆相对于第一车辆的位置应用预设的第一加权系数公式计算第二车辆对应的第一加权系数;
根据第二车辆相对于第一车辆的车速和第二车辆相对第一车辆的距离应用预设的第二加权系数公式计算第二车辆对应的第二加权系数。
2.根据权利要求1所述的计算潜在碰撞严重指数的方法,其特征在于,所述如果第一车辆和第二车辆发生碰撞,根据预先获取的第一车辆航向角和第二车辆航向角计算第一车辆与第二车辆的碰撞角包括:
如果第一车辆和第二车辆发生碰撞,根据预先获取的第一车辆航向角和第二车辆航向角采用角度公式计算第一车辆与第二车辆的碰撞角,该角度公式为:
θci=|π-θti-θ|
上述公式中,θ表示第一车辆航向角,θti表示第i个第二车辆航向角,θci表示第一车辆与第i个第二车辆的碰撞角,i表示第二车辆的编号,i为大于等于1的正整数。
3.根据权利要求1所述的计算潜在碰撞严重指数的方法,其特征在于,所述拟合公式为:
f(x)=a0+a1cos(x·w)+b1sin(x·w)+a2cos(2x·w)+b2sin(2x·w)+a3cos(3x·w)+b3sin(3x·w)+a4cos(4x·w)+b4sin(4x·w)+a5cos(5x·w)+b5sin(5x·w)+a6cos(6x·w)+b6sin(6x·w)
其中,a0-aj、b1-bj和w为预先设置的参数;其中,j∈1~6,x表示第一车辆与第i个第二车辆的碰撞角。
4.根据权利要求3所述的计算潜在碰撞严重指数的方法,其特征在于,a0设置为-16.12,a1设置为-19.06,a2设置为11.46,a3设置为19.86,a4设置为7.853,a5设置为-1.154,a6设置为-1.33;w设置为1.371;b1设置为28.91,b2设置为26.71,b3设置为3.564,b4设置为-8.256,b5设置为-4.983,b6设置为-0.4932。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于清华大学,未经清华大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110678719.0/1.html,转载请声明来源钻瓜专利网。
- 上一篇:核电用法兰材料的制备方法
- 下一篇:一种编织线分切用杂物自动收集装置