隨著自動駕駛技術(shù)的快速發(fā)展，自動駕駛的研發(fā)逐漸形成一整套的流程，包括數(shù)據(jù)采集，清洗標(biāo)注，算法訓(xùn)練，仿真測試到量產(chǎn)等各技術(shù)環(huán)節(jié)。通過復(fù)雜的步驟從原始數(shù)據(jù)中提出高價(jià)值的信息，其中對原始數(shù)據(jù)的精準(zhǔn)采集是實(shí)現(xiàn)車輛環(huán)境感知的基石。毫米波雷達(dá)因其出色的測距、測速能力以及對惡劣天氣的魯棒性，成為必要的傳感器之一。

本文將以4D毫米波雷達(dá)ARS548為例，分享毫米波雷達(dá)如何快速實(shí)現(xiàn)數(shù)據(jù)采集，可視化及存儲策略。關(guān)于毫米波雷達(dá)的特性可進(jìn)一步了解文章《毫米波雷達(dá)技術(shù)解析》。

一、ARS548毫米波雷達(dá)概述

ARS548是 4D高分辨率成像毫米波雷達(dá)（4D High Resolution Radar），如圖1所示。它能夠有效的測量距離（Range），速度（Velocity），水平角度（Azimuth）和俯仰角度或高度（Elevation）四個(gè)維度的信息，具備感知目標(biāo)三維空間位置能力。具備以下特性：

圖1：ARS548（圖片來源于網(wǎng)絡(luò)）

1. 探測距離與視場角：最大探測距離可達(dá)300米，水平視場角為±60°，垂直視場角為±4°至±14°。

2. 數(shù)據(jù)輸出：支持最多800個(gè)Detection和50個(gè)Object的同時(shí)輸出，測量周期為50ms至100ms可調(diào)。

3. 接口：采用100 BASE-T1接口，支持通過車載以太網(wǎng)轉(zhuǎn)換器與標(biāo)準(zhǔn)以太網(wǎng)設(shè)備進(jìn)行通信。

4. 通信協(xié)議：數(shù)據(jù)通過UDP協(xié)議傳輸，使用多播地址方式進(jìn)行數(shù)據(jù)傳輸。

二、硬件集成

為了能快速采集到毫米波雷達(dá)的數(shù)據(jù)，需要對其進(jìn)行硬件集成與連接，如圖2所示。

圖2：Radar 硬件連接方案

以同時(shí)連接3個(gè)毫米波雷達(dá)為例，整個(gè)系統(tǒng)均支持12V的供電運(yùn)行，可快速實(shí)現(xiàn)各設(shè)備穩(wěn)定供電運(yùn)行。在數(shù)據(jù)鏈路采集上，需要將車載以太網(wǎng)接口的數(shù)據(jù)轉(zhuǎn)換到標(biāo)準(zhǔn)以太網(wǎng)，這一轉(zhuǎn)換過程涉及以下步驟：

1. 網(wǎng)口轉(zhuǎn)換：使用如康謀NETLion100轉(zhuǎn)換器，將車載以太網(wǎng)信號轉(zhuǎn)換為標(biāo)準(zhǔn)以太網(wǎng)信號。NETLion100集成了網(wǎng)絡(luò)分線器(Tap)和雙介質(zhì)轉(zhuǎn)換器于一身，支持BroadR-Reach®網(wǎng)絡(luò)信號與100BASE-TX以太網(wǎng)之間的雙向轉(zhuǎn)換，并提供LED信號實(shí)時(shí)顯示數(shù)據(jù)傳輸質(zhì)量，可快速進(jìn)行數(shù)據(jù)轉(zhuǎn)換和分析。

2. 數(shù)據(jù)傳輸原理：雷達(dá)數(shù)據(jù)以UDP包的形式發(fā)送至規(guī)定的多播地址，康謀BRICK plus設(shè)備通過網(wǎng)絡(luò)接口接收這些數(shù)據(jù)包。BRICKplus提供廣泛的接口支持多個(gè)傳感器同時(shí)連接，實(shí)現(xiàn)高帶寬數(shù)據(jù)的采集、處理和記錄。

3. 采集與監(jiān)控：在BRICK plus端，可以使用Wireshark等網(wǎng)絡(luò)分析工具來捕獲和分析從雷達(dá)發(fā)送的數(shù)據(jù)包，檢查數(shù)據(jù)包是否正確傳輸。

三、軟件開發(fā)

為了采集到毫米波雷達(dá)輸出的點(diǎn)云數(shù)據(jù)，需要理解數(shù)據(jù)的傳輸形式并能夠?qū)崟r(shí)解析。具體來說需要解決如下的問題：

1. 數(shù)據(jù)采集：實(shí)時(shí)從ARS548雷達(dá)獲取原始數(shù)據(jù)，這要求系統(tǒng)能夠與雷達(dá)硬件接口進(jìn)行高效通信，并且能夠處理高頻率的數(shù)據(jù)流。

2. 數(shù)據(jù)解析：將原始數(shù)據(jù)轉(zhuǎn)換為可讀的格式，如目標(biāo)的距離、速度和角度。需要對雷達(dá)數(shù)據(jù)包進(jìn)行解碼，并提取出有用的信息。

3. 數(shù)據(jù)可視化：將解析后的數(shù)據(jù)以圖形化的方式展示，便于分析和監(jiān)控。需要實(shí)時(shí)更新數(shù)據(jù)顯示。

ROS提供了模塊化的節(jié)點(diǎn)系統(tǒng)，便于管理和擴(kuò)展。每個(gè)節(jié)點(diǎn)可以獨(dú)立開發(fā)和測試，使得系統(tǒng)的整體復(fù)雜性得到有效管理。十分契合我們對問題的拆解以及功能節(jié)點(diǎn)的完成。此外采用ROS的發(fā)布/訂閱模型可以實(shí)時(shí)采集傳輸?shù)睦走_(dá)數(shù)據(jù)。

對于單個(gè)毫米波雷達(dá)的采集，解析和可視化，可以通過在ROS中對應(yīng)創(chuàng)建3個(gè)節(jié)點(diǎn)來實(shí)現(xiàn)。3個(gè)節(jié)點(diǎn)分別負(fù)責(zé)Radar設(shè)備接收UDP數(shù)據(jù)，解析并發(fā)布ROS消息，以及將雷達(dá)檢測和對象信息轉(zhuǎn)換為可視化Marker消息。

針對3（多）個(gè)毫米波雷達(dá)的同時(shí)采集，我們采用每個(gè)節(jié)點(diǎn)同時(shí)發(fā)布和訂閱多個(gè)topic數(shù)據(jù)實(shí)現(xiàn)同時(shí)采集和傳輸。并且為了實(shí)現(xiàn)多個(gè)雷達(dá)數(shù)據(jù)的同時(shí)顯示，采用Foxglove進(jìn)行可視化呈現(xiàn)，呈現(xiàn)效果如圖3所示：

圖3 ：Radar 可視化

隨后，采用ROSbag進(jìn)行數(shù)據(jù)存儲，能夠確保數(shù)據(jù)的完整性和準(zhǔn)確性。

四、總結(jié)

通過集成高性能的硬件設(shè)備和采用ROS框架，實(shí)現(xiàn)了毫米波雷達(dá)數(shù)據(jù)的高效采集、實(shí)時(shí)處理和直觀可視化，同時(shí)支持多雷達(dá)系統(tǒng)的數(shù)據(jù)同步采集和存儲，提供了一個(gè)穩(wěn)定、靈活且可擴(kuò)展采集方案。