点云数据的处理方法、设备及车辆与流程

摘要: 本技术涉及车辆,尤其涉及一种点云数据的处理方法、设备及车辆。背景技术:1、激光雷达作为自动驾驶系统和高级驾驶辅助系统的核心传感器,用于获取周围环境的点云数据。然...
点云数据的处理方法、设备及车辆与流程

本技术涉及车辆,尤其涉及一种点云数据的处理方法、设备及车辆。

背景技术:

1、激光雷达作为自动驾驶系统和高级驾驶辅助系统的核心传感器,用于获取周围环境的点云数据。然而,点云数据通常以高频率、高密度的离散形式生成,需经过复杂的组包、存储和传输流程才能被下游应用层处理。

2、现有技术中,普遍采用基于系统级芯片(system on chip, soc)的软件方案完成组包与存储,该方法的核心思想是利用soc芯片的高集成度,在其上运行特定的软件或固件,即依赖软件逻辑对点云数据进行无效数据过滤、多包重组和内存搬运,导致存在较大的延迟性,无法发挥固态激光雷达本身的高速采集优势,进而制约了车辆的实时决策响应能力。

3、综上所述,提供一种可实现点云数据从传感器至存储器低延迟直传的处理方法,是亟待解决的技术问题。

技术实现思路

1、本技术提供一种点云数据的处理方法、设备及车辆,用以实现点云数据从采集到存储的微秒级低延迟直传。

2、第一方面,本技术实施例提供一种点云数据的处理方法,包括:

3、获取多个点云数据;其中,所述多个点云数据是通过对车辆在行驶工况下实时采集到的原始点云数据进行筛选后得到的;

4、通过预设的第一多级计数器组,计算得到各点云数据的第一存储地址,并基于第一存储地址将对应的点云数据写入双口存储器中;

5、响应于读取所述双口存储器中的点云数据,通过预设的第二多级计数器组,计算得到各点云数据的第二存储地址,并基于第二存储地址将对应的点云数据写入目标请求方,以供下游应用层调用所述多个点云数据。

6、在一种可能的实施方式中,所述第一多级计数器组包括两组多级计数器组,每组多级计数器组中包括包计数器、第一段计数器、垂直包计数器、第一子帧计数器以及第二子帧计数器;

7、所述通过预设的第一多级计数器组,计算得到各点云数据的第一存储地址,包括:

8、对所述多个点云数据进行分流处理,得到第一点云数据包与第二点云数据包;

9、针对每个点云数据包中的每个点云数据,依次通过所述包计数器、所述第一段计数器、所述垂直包计数器、所述第一子帧计数器以及所述第二子帧计数器对所述点云数据进行计数处理,得到所述点云数据的第一存储地址。

10、在一种可能的实施方式中,所述依次通过所述包计数器、所述第一段计数器、所述垂直包计数器、所述第一子帧计数器以及所述第二子帧计数器对所述点云数据进行计数处理,得到所述点云数据的计数结果,包括:

11、通过所述包计数器对所述点云数据进行递增计数,在所述包计数器输出的第一计数值达到所述包计数器的第一计数范围时,启动所述第一段计数器递增计数;

12、将所述第一段计数器输出的第二计数值输入至第一乘法器中,得到第一计数结果,并在所述第二计数值达到所述第一段计数器的第二计数范围时,启动所述垂直包计数器递增计数;

13、将所述垂直包计数器输出的第三计数值输入至第二乘法器中,得到第二计数结果,并在所述第三计数值达到所述垂直包计数器的第三计数范围时,启动所述第一子帧计数器递增计数;

14、将所述第一子帧计数器输出的第四计数值输入至第三乘法器中,得到第三计数结果,并在所述第四计数值达到所述第一子帧计数器的第四计数范围时,启动所述第二子帧计数器递增计数;

15、将所述第二子帧计数器输出的第五计数值输入至第四乘法器中,得到第四计数结果;

16、基于所述第一计数结果、所述第二计数结果、所述第三计数结果以及所述第四计数结果,得到所述第一存储地址。

17、在一种可能的实施方式中,所述方法还包括:

18、在所述第一点云数据包中的点云数据,或者,所述第二点云数据包中的点云数据均写入所述双口存储器中时,按序读取出所述点云数据,并将所述点云数据写入预先配置的第一数据缓冲队列中;

19、和/或,

20、将所述多个点云数据对应的帧信息包数据写入预先配置的第二数据缓冲队列中。

21、在一种可能的实施方式中,所述第二多级计数器组包括行计数器、第二段计数器、第三子帧计数器以及帧计数器;

22、所述通过预设的第二多级计数器组,计算得到各点云数据的第二存储地址,包括:

23、在所述第一数据缓冲队列中的点云数据量达到预设的突发传输长度阈值时,将存储在所述第一数据缓冲队列中的点云数据按照所述突发传输长度阈值划分为多个点云数据块;

24、针对每个点云数据块,依次通过所述行计数器、所述第二段计数器、所述第三子帧计数器以及所述帧计数器,计算得到所述点云数据块内首个点云数据的起始存储地址;

25、将所述起始存储地址确定为所述点云数据块中各点云数据的第二存储地址。

26、在一种可能的实施方式中,所述依次通过所述行计数器、所述第二段计数器、所述第三子帧计数器以及所述帧计数器,计算得到所述点云数据块内首个点云数据的起始存储地址,包括:

27、通过所述行计数器对所述首个点云数据进行递增计数,将所述行计数器输出的第六计数值输入至第五乘法器中,得到第五计数结果;并在所述第六计数值达到所述行计数器的第五计数范围时,启动所述第二段计数器递增计数;

28、将所述第二段计数器输出的第七计数值与所述第二段计数器的第七计数范围的起始值之间的每个计数值相加,得到第六计数结果,并在所述第七计数值达到所述第七计数范围时,启动所述第三子帧计数器递增计数;

29、将所述第三子帧计数器输出的第八计数值与所述第三子帧计数器的第八计数范围的起始值之间的每个计数值相加,得到第七计数结果,并在所述第八计数值达到所述第八计数范围时,启动所述帧计数器递增计数;

30、将所述帧计数器输出的第九计数值输入至第六乘法器中,得到第八计数结果;

31、基于所述第五计数结果、所述第六计数结果、所述第七计数结果以及所述第八计数结果,得到所述起始存储地址。

32、在一种可能的实施方式中,乘法器的运算规则为:将计数器的计数范围的起始值至所述计数器输出的计数值之间的每个计数值,分别与所述乘法器对应的预设权重系数相乘法后进行累加,得到所述乘法器的运算结果。

33、在一种可能的实施方式中,所述方法还包括:

34、针对每个点云数据块,将所述点云数据块基于对应的第二存储地址写入所述目标请求方后,生成行中断信号;

35、在所述多个点云数据均写入所述目标请求方后,从所述第二数据缓冲队列中读取出所述帧信息包数据,并将所述帧信息包数据写入所述目标请求方,生成帧中断信号。

36、第二方面,本技术实施例提供一种点云数据的处理装置,包括:

37、第一处理模块,用于获取多个点云数据;其中,所述多个点云数据是通过对车辆在行驶工况下实时采集到的原始点云数据进行筛选后得到的;

38、第二处理模块,用于通过预设的第一多级计数器组,计算得到各点云数据的第一存储地址,并基于第一存储地址将对应的点云数据写入双口存储器中;

39、第三处理模块,用于响应于读取所述双口存储器中的点云数据,通过预设的第二多级计数器组,计算得到各点云数据的第二存储地址,并基于第二存储地址将对应的点云数据写入目标请求方,以供下游应用层调用所述多个点云数据。

40、在一种可能的实施方式中,所述第一多级计数器组包括两组多级计数器组,每组多级计数器组中包括包计数器、第一段计数器、垂直包计数器、第一子帧计数器以及第二子帧计数器;

41、所述第二处理模块具体用于:

42、对所述多个点云数据进行分流处理,得到第一点云数据包与第二点云数据包;

43、针对每个点云数据包中的每个点云数据,依次通过所述包计数器、所述第一段计数器、所述垂直包计数器、所述第一子帧计数器以及所述第二子帧计数器对所述点云数据进行计数处理,得到所述点云数据的第一存储地址。

44、在一种可能的实施方式中,所述第二处理模块具体还用于:

45、通过所述包计数器对所述点云数据进行递增计数,在所述包计数器输出的第一计数值达到所述包计数器的第一计数范围时,启动所述第一段计数器递增计数;

46、将所述第一段计数器输出的第二计数值输入至第一乘法器中,得到第一计数结果,并在所述第二计数值达到所述第一段计数器的第二计数范围时,启动所述垂直包计数器递增计数;

47、将所述垂直包计数器输出的第三计数值输入至第二乘法器中,得到第二计数结果,并在所述第三计数值达到所述垂直包计数器的第三计数范围时,启动所述第一子帧计数器递增计数;

48、将所述第一子帧计数器输出的第四计数值输入至第三乘法器中,得到第三计数结果,并在所述第四计数值达到所述第一子帧计数器的第四计数范围时,启动所述第二子帧计数器递增计数;

49、将所述第二子帧计数器输出的第五计数值输入至第四乘法器中,得到第四计数结果;

50、基于所述第一计数结果、所述第二计数结果、所述第三计数结果以及所述第四计数结果,得到所述第一存储地址。

51、在一种可能的实施方式中,所述装置还包括第四处理模块,用于:

52、在所述第一点云数据包中的点云数据,或者,所述第二点云数据包中的点云数据均写入所述双口存储器中时,按序读取出所述点云数据,并将所述点云数据写入预先配置的第一数据缓冲队列中;

53、和/或,

54、将所述多个点云数据对应的帧信息包数据写入预先配置的第二数据缓冲队列中。

55、在一种可能的实施方式中,所述第二多级计数器组包括行计数器、第二段计数器、第三子帧计数器以及帧计数器;

56、所述第三处理模块具体用于:

57、在所述第一数据缓冲队列中的点云数据量达到预设的突发传输长度阈值时,将存储在所述第一数据缓冲队列中的点云数据按照所述突发传输长度阈值划分为多个点云数据块;

58、针对每个点云数据块,依次通过所述行计数器、所述第二段计数器、所述第三子帧计数器以及所述帧计数器,计算得到所述点云数据块内首个点云数据的起始存储地址;

59、将所述起始存储地址确定为所述点云数据块中各点云数据的第二存储地址。

60、在一种可能的实施方式中,所述第三处理模块具体还用于:

61、通过所述行计数器对所述首个点云数据进行递增计数,将所述行计数器输出的第六计数值输入至第五乘法器中,得到第五计数结果;并在所述第六计数值达到所述行计数器的第五计数范围时,启动所述第二段计数器递增计数;

62、将所述第二段计数器输出的第七计数值与所述第二段计数器的第七计数范围的起始值之间的每个计数值相加,得到第六计数结果,并在所述第七计数值达到所述第七计数范围时,启动所述第三子帧计数器递增计数;

63、将所述第三子帧计数器输出的第八计数值与所述第三子帧计数器的第八计数范围的起始值之间的每个计数值相加,得到第七计数结果,并在所述第八计数值达到所述第八计数范围时,启动所述帧计数器递增计数;

64、将所述帧计数器输出的第九计数值输入至第六乘法器中,得到第八计数结果;

65、基于所述第五计数结果、所述第六计数结果、所述第七计数结果以及所述第八计数结果,得到所述起始存储地址。

66、在一种可能的实施方式中,乘法器的运算规则为:将计数器的计数范围的起始值至所述计数器输出的计数值之间的每个计数值,分别与所述乘法器对应的预设权重系数相乘法后进行累加,得到所述乘法器的运算结果。

67、在一种可能的实施方式中,所述装置还包括第五处理模块,用于:

68、针对每个点云数据块,将所述点云数据块基于对应的第二存储地址写入所述目标请求方后,生成行中断信号;

69、在所述多个点云数据均写入所述目标请求方后,从所述第二数据缓冲队列中读取出所述帧信息包数据,并将所述帧信息包数据写入所述目标请求方,生成帧中断信号。

70、第三方面,本技术实施例提供一种电子设备,包括:存储器,处理器;

71、所述存储器存储计算机执行指令;

72、所述处理器执行所述存储器存储的计算机执行指令,使得所述处理器执行如上第一方面和/或第一方面各种可能的实施方式。

73、第四方面,本技术实施例提供一种计算机可读存储介质,所述计算机可读存储介质中存储有计算机执行指令,所述计算机执行指令被处理器执行时用于实现如上第一方面和/或第一方面各种可能的实施方式。

74、第五方面,本技术实施例提供一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现如上第一方面和/或第一方面各种可能的实施方式。

75、第六方面,本技术实施例提供一种车辆,包括车辆主体以及控制器,所述控制器用于执行如上第一方面和/或第一方面各种可能的实施方式。

76、本技术提供的一种点云数据的处理方法、设备及车辆,首先获取经筛选后的多个点云数据,随后通过预设的第一多级计数器组实时计算各点云数据在双口存储器中的第一存储地址并写入,再响应于读取双口存储器中的点云数据,通过预设的第二多级计数器组实时计算各点云数据在目标请求方中的第二存储地址并写入,最终供下游应用层调用。通过上述方法,将点云数据从采集端到目标请求方的完整存储过程分解为两级硬件流水线,具体为第一级完成数据从传感器前端至双口ram的快速缓冲,第二级完成数据从双口ram至目标存储器的重组写入,整个过程均由纯硬件逻辑独立完成地址计算与数据搬运,无需中央处理器介入管理,从根本上消除了软件处理链路中的中断响应、上下文切换与多次数据拷贝引入的处理延迟,使得点云数据能够以紧凑、连续的方式分别存入双口ram和目标请求方,最终在目标请求方中形成完整自描述的数据帧,为下游应用层提供了高实时性、高吞吐率且可直接调用的数据支撑。