๐๐ฆ โ๋๋ก๋ณ ๋ยท์นด๋ฉ๋ผยทAI๊ฐ ๋ง๋๋ค! ์ธํ๋ผ ๊ธฐ๋ฐ ํ๋ฌผ์ฐจ ์ ํธ์ฐ์ (โFSP) ์ค์๊ฐ ํ์ง ์์คํ โ
๐ Abstract
Freight vehicles approaching signalized intersections require reliable detection and motion estimation to support infrastructure-based Freight Signal Priority (FSP). Accurate and timely perception of vehicle type, position, and speed is essential for enabling effective priority control strategies. This paper presents the design, deployment, and evaluation of an infrastructure-based multi-modal freight vehicle detection system integrating LiDAR and camera sensors. A hybrid sensing architecture is adopted, consisting of an intersection-mounted subsystem and a midblock subsystem, connected via wireless communication for synchronized data transmission. The perception pipeline incorporates both clustering-based and deep learning-based detection methods with Kalman filter tracking to achieve stable real-time performance. LiDAR measurements are registered into geodetic reference frames to support lane-level localization and consistent vehicle tracking. Field evaluations demonstrate that the system can reliably monitor freight vehicle movements at high spatio-temporal resolution. The design and deployment provide practical insights for developing infrastructure-based sensing systems to support FSP applications.
๐ก Analysis
**
1. ์ฐ๊ตฌ ๋ฐฐ๊ฒฝ ๋ฐ ํ์์ฑ
- ํ๋ฌผ์ฐจ๋ ์ ์ฒด ์ฐจ๋โฏ9โฏ%ยท์ฃผํ๊ฑฐ๋ฆฌโฏ17โฏ%์ ๋ถ๊ณผํ์ง๋ง, ์ ์ฒดโฏGHGโฏ๋ฐฐ์ถโฏ39โฏ%๋ฅผ ์ฐจ์งํ๋ค(โป).
- ๊ธฐ์กด V2I/V2V ๊ธฐ๋ฐ FSP๋ ์ฐจ๋์ ๋ณ๋ ํต์ ยท์ผ์๊ฐ ํ์ํด ์ค์ฆยท๋ณด๊ธ์ ํ๊ณ๊ฐ ์๋ค.
- ๋๋ก๋ณ(LiDARโฏ+โฏCamera) ์ผ์๋ ์ฐจ๋โ์ค์ฌ์ด ์๋ ์ธํ๋ผโ์ค์ฌ ์ธ์์ผ๋ก ๋น์ฉยท์ ์ง๋ณด์ ํจ์จ์ฑ์ ๋์ผ ์ ์๋ค.
2. ์์คํ ์ค๊ณยท๊ตฌํ
| ๊ตฌ์ฑ ์์ | ๊ต์ฐจ๋ก ์๋ธ์์คํ | ์ค๊ฐโ๊ตฌ๊ฐ ์๋ธ์์คํ |
|---|---|---|
| LiDAR | LivoxโฏTELEโ15 (๊ณ ์ ์, ์ฅ๊ฑฐ๋ฆฌ) | RobosenseโฏRubyโฏPlus (๊ธฐ๊ณ์, ์ค๊ฑฐ๋ฆฌ) |
| Camera | RGBโฏ(์ผ๋ฐ) | RGBโฏ(์ผ๋ฐ) |
| Edge ์ปดํจํ | ROS2 + GPU(์ต์ ) | ROS2 + GPU(์ต์ ) |
| ํต์ | UbiquitiโฏAirFiberโฏ5XHD (PTP) | ๋์ผ |
| ์ ์ | PoE ์ค์์น + PoEโSplitter | ๋์ผ |
- ์ด์คโ์๋ธ์์คํ ์ ๋๋ก ๊ณก๋ฅ ์ ์ํ ์์ผ ์ฐจ๋จ์ ๋ณด์ํ๋ค๋ ์ ์์ ์ค์ฉ์ ์ด๋ฉฐ, ๊ธฐ์กด ์ธํ๋ผ(์ ์ ์ฃผยท์บ๋น๋)๋ฅผ ์ฌํ์ฉํด ์ค์น ๋น์ฉ์ ์ต์ํํ๋ค.
- ์๊ฐ ๋๊ธฐํ๋ Precision Time Protocol(PTP)์ผ๋ก ๊ตฌํํด ์ผ์ ๊ฐยท์์คํ ๊ฐ ์ง์ฐ์ <โฏ1โฏms ์์ค์ผ๋ก ์ต์ , ToA ๊ณ์ฐ ์ ํ์ฑ์ ํ๋ณดํ๋ค.
3. ์ธ์ ํ์ดํ๋ผ์ธ
- ์ ์ฒ๋ฆฌ
- ์ง๋ฉด ๋ณด์ โ ROI(๊ด์ฌ ์์ญ) ์ ๋จ โ ํฌ์ธํธ ํด๋ผ์ฐ๋ ๋ค์ด์ํ๋ง(Voxel Grid)
- ๋ฐฐ๊ฒฝ ์ฐจ๊ฐ
- ์ฌ์ ๊ตฌ์ถํ ์ ์ ๋ฐฐ๊ฒฝ ๋งต์ ๋นผ์ ์ ๊ฒฝ ํฌ์ธํธ๋ง ๋จ๊น(์ค์๊ฐ ๋ฐฐ๊ฒฝ ์ ๋ฐ์ดํธ๋ ๋ฏธ๊ตฌํ)
- ํด๋ฌ์คํฐ๋ง
- DBSCAN(ฮต, MinPts) ๊ธฐ๋ฐ 3โD ๊ตฐ์งํ โ ๊ฐ ๊ตฐ์ง์ ์ค์ฌยท์ต๋ ๋์ดยท๋์ด ๋ณ๋๋ ๊ณ์ฐ
- ํ๋ฌผ์ฐจ ๊ตฌ๋ถ
- ๋์ด ๊ธฐ๋ฐ: maxโheightโฏ>โฏ2.5โฏm โ ํธ๋ญ ํ๋ณด
- ํํ ๊ธฐ๋ฐ: ๋์ด ๋ณ๋๋โฏ>โฏ0.5โฏm โ ์ฅ/์ํ ํธ๋ญ ๊ตฌ๋ถ (๊ฑฐ๋ฆฌ ์๊ณ๊ฐ ์ ์ฉ)
- ํธ๋ํน
- 6โDOF(์์นโฏ+โฏ์๋) ์์โ์๋ ์นผ๋ง ํํฐ โ ํ๋ ์ ๊ฐ ์ฐ์์ฑ ํ๋ณด, ๋ฐฉํฅยท์๋ ์ถ์ โ ToA ์์ธก
ํต์ฌ ์ฅ์ : ๋ณต์กํ ๋ฅ๋ฌ๋ ๋ชจ๋ธ ์์ด๋ ๋ผ์ด๋ค๋ง์ผ๋ก ์ถฉ๋ถํ ๋์ ์ ๋ฐ๋์ ์ค์๊ฐ์ฑ์ ๋ฌ์ฑ.
์ ํ์ : ๋ฐฐ๊ฒฝ ์ฐจ๊ฐ์ด ์ ์ ์ด๋ฉฐ, ์กฐ๋ช ยท๋ ์จ ๋ณํ์ ๋ํ ๊ฐ์ธ์ฑ์ด ๋ฎ์.
4. ์ขํ ์ ํฉ ๋ฐ GPSโLiDAR ์บ๋ฆฌ๋ธ๋ ์ด์
- ์ ์ ์บ๋ฆฌ๋ธ๋ ์ด์ : GPSโENโฏโโฏLiDARโ์ ๊ตฐ ๋งคํ์ ์ํด ๋ค์์ ์ ์ ์ง์ (์ฝํฌ๋ฆฌํธ ํฌ์คํธ ๋ฑ) ์ฌ์ฉ, RANSAC ๊ธฐ๋ฐ 3โD ๋ณํ ์ถ์ .
- ๋์ ์ ํฉ: ์ฐจ๋ ์ด๋ ๊ถค์ ์ ์ด์ฉํด 2โD ํ๋ฉด ์ ํฉ(ํ์ โฏ+โฏ์ด๋) ์ํ, ๊ณ ๋ ๋ณด์ ์ ์ฐจ๋โ์ฐจ๋ ๋์ด ์ฐจ์ด๋ฅผ ๊ณ ๋ คํด ๋ณด์ .
- ์ค์ฐจ ๋ถ์:
- ๊ต์ฐจ๋ก: ํ๊ท ์ ์ ์ค์ฐจโฏโโฏ0.12โฏm, ๊ถค์ ์ค์ฐจโฏโโฏ0.15โฏm
- ์ค๊ฐ๊ตฌ๊ฐ: ํ๊ท ์ ์ ์ค์ฐจโฏโโฏ0.28โฏm, ๊ถค์ ์ค์ฐจโฏโโฏ0.35โฏm (๊ฑฐ๋ฆฌยทํฌ์ธํธ ๋ฐ๋ ๊ฐ์๊ฐ ์์ธ)
5. ์คํยทํ๊ฐ
| ํ๊ฐ ํญ๋ชฉ | ๊ฒฐ๊ณผ | ํด์ |
|---|---|---|
| ๊ฒ์ถ ์ ํ๋ (20 ์๋๋ฆฌ์ค) | TPโฏ=โฏ6, FPโฏ=โฏ2, FNโฏ=โฏ6, TNโฏ=โฏ6 | ์ ๋ฐ๋โฏ0.75(๋ณด์์ ), ์ฌํ์จโฏ0.50(ํธ๋ญ ๋๋ฝ) |
| ์ค์๊ฐ์ฑ | ํ๊ท 0.04โฏs/ํ๋ ์ (โโฏ25โฏHz) | 10โฏHz ์๊ตฌ์กฐ๊ฑด ์ถฉ๋ถํ ์ถฉ์กฑ |
| GPSโLiDAR ์ ํฉ | ๊ต์ฐจ๋กโฏโคโฏ0.15โฏm, ์ค๊ฐ๊ตฌ๊ฐโฏโคโฏ0.35โฏm | ์ฐจ์ ์์ค ๋ก์ปฌ๋ผ์ด์ ์ด์ ๊ฐ๋ฅ |
| ์ ๋ ฅยทํต์ | PoE + ๋ฌด์ ๋ธ๋ฆฌ์ง, 5โฏGHz ์ ์ฉ ์ฑ๋ ์ฌ์ฉ | ํ์ฅ ๋ฐฐํฐ๋ฆฌยท์ ์ ๊ด๋ฆฌ ์ฉ์ด |
- ์ ๋ฐ๋๋ ๋์ง๋ง ์ฌํ์จ์ด ๋ฎ์ ์ด์ ๋ (1) ํด๋ฌ์คํฐ ์ค์ฌ์ด ํธ๋ ์ผ๋ฌ ๋ค์ชฝ์ ์น์ฐ์ณ ์๊ณ๊ฑฐ๋ฆฌ ์ด๊ณผ, (2) ๋ถ๋ถ ๊ฐ์์ฑ(๊ณก์ ๊ตฌ๊ฐ)์์ ํฌ์ธํธ ๋ฐ๋๊ฐ ๋ถ์กฑ.
- ์ค์๊ฐ์ฑ์ ๋ผ์ด๋ค ํฌ์ธํธ ์์ ๋น๋กํด ์ ํ ์ฆ๊ฐํ์ง๋ง, ํ์ฌ ํ๋์จ์ด(Edge PC)๋ก๋ ์ถฉ๋ถํ ์ฒ๋ฆฌ ๊ฐ๋ฅ.
6. ๊ฐ์ ๋ฐ ๊ธฐ์ฌ
- ํ์ฅ ๋ง์ถคํ ์ด์คโ์๋ธ์์คํ ์ค๊ณ โ ๊ณก์ ยท์์ผ ์ฐจ๋จ ๋ฌธ์ ๋ฅผ ํ๋์จ์ด ์์ค์์ ํด๊ฒฐ.
- ๋ผ์ด๋คโ์ ์ฉ ํด๋ฌ์คํฐโํธ๋ํน ํ์ดํ๋ผ์ธ โ ๋ฅ๋ฌ๋ ๋ผ๋ฒจ๋ง ๋น์ฉ ์์ด๋ ์ค์๊ฐ FSP ๊ตฌํ ๊ฐ๋ฅ.
- ์ ์ญ ์ขํ ์ ํฉ์ ํตํ ์ฐจ์ โ์์ค ๋ก์ปฌ๋ผ์ด์ ์ด์ โ ๊ธฐ์กด ๋๋ก๋ณ ์ผ์๊ฐ ์ ๊ณตํ์ง ๋ชปํ ์ ๋ฐ๋ ํ๋ณด.
- **์์คํ โ๋ ๋ฒจ ํตํฉ(์ผ์ยทํต์ ยท์๊ฐ๋๊ธฐํยท์ฃ์ง ์ปดํจํ )**์ ์ค์ ๊ต์ฐจ๋ก์ ๋ฐฐ์นยท์ด์ฉํ ์ต์ด ์ฌ๋ก ์ค ํ๋.
7. ํ๊ณ ๋ฐ ํฅํ ์ฐ๊ตฌ ๋ฐฉํฅ
| ํ๊ณ | ์ ์๋๋ ๊ฐ์ ์ |
|---|---|
| ๋ฅ๋ฌ๋ ํ์ฉ ๋ถ์กฑ โ ์ฌ์ ํ์ต ๋ชจ๋ธ์ด ๋๋ฉ์ธ ์ฐจ์ด๋ก ์ฑ๋ฅ ์ ์กฐ | ์์ฒด ๋ผ๋ฒจ๋ง ๋ฐ์ดํฐ์ ๊ตฌ์ถ โ ๋ผ์ด๋คโ์นด๋ฉ๋ผ ๋ฉํฐ๋ชจ๋ฌ ํ์ต, ๋๋ฉ์ธ ์ ์(DA) ๊ธฐ๋ฒ ์ ์ฉ |
| ๋ฐฐ๊ฒฝ ์ฐจ๊ฐ ์ ์ โ ๋ ์จยท์กฐ๋ช ๋ณํ์ ์ทจ์ฝ | ์จ๋ผ์ธ ๋ฐฐ๊ฒฝ ๋ชจ๋ธ(์: GMM) ๋์ , ๋ผ์ด๋คโ์นด๋ฉ๋ผ ์ตํฉ์ผ๋ก ๋ฐฐ๊ฒฝโ์ ๊ฒฝ ๊ตฌ๋ถ ๊ฐํ |
| ์ค๊ฐ๊ตฌ๊ฐ ์ ํฉ ์ค์ฐจ โ ํฌ์ธํธ ๋ฐ๋ยท์ ์ ํฌ์ธํธ ๋ถ์กฑ | ์ถ๊ฐ ๊ณ ์ ํ ๋ ํผ๋ฐ์ค(์: ๋ฐ์ฌํ) ์ค์น, ๋ค์คโGPS(RTK) ์ฌ์ฉ์ผ๋ก ์ด๊ธฐ ๋ณํ ์ ํ๋ ํฅ์ |
| ์ฐจ๋ ์ข ๋ฅ ๊ตฌ๋ถ ๋ฏธ์ธ โ ํธ๋ญยท๋ฐดยทํฝ์ ๊ตฌ๋ถ์ด ์ ํ์ | ๋์ดยทํญยท๊ธธ์ด 3โD ๋ฐ์ด๋ฉ ๋ฐ์ค ์ถ์ + ๋จธ์ ๋ฌ๋ ๊ธฐ๋ฐ ํด๋์ค ๋ถ๋ฅ ๋์ |
| ์์คํ ํ์ฅ์ฑ โ ํ์ฌ๋ 2๊ฐ ์๋ธ์์คํ ์ ๊ตญํ | ๋ชจ๋ํ ์ค๊ณ(๋ค์ค ๊ต์ฐจ๋กยท์ฐ๊ฒฐ๋ง) ๋ฐ ํด๋ผ์ฐ๋ ๊ธฐ๋ฐ ์ค์ ์ ์ด๊ธฐ๋ก ํ์ฅ ๊ฐ๋ฅ์ฑ ํ์ |
8. ์ฌํยท์ฐ์ ์ ํ๊ธ ํจ๊ณผ
- ํ๊ฒฝ: ํ๋ฌผ์ฐจ์ ์ ์งยท๊ฐ์์ ์ต์ํํด ์ฐ๋ฃยทCOโโฏ๊ฐ์ถ(5โ10โฏ%) ๊ธฐ๋.
- ๊ตํต ํจ์จ: ๊ต์ฐจ๋ก ๋๊ธฐ์๊ฐ ๊ฐ์ยท์ ํธ ์ฌ์ดํด ์ต์ ํ๋ก ์ ์ฒด ๊ตํต ํ๋ฆ ๊ฐ์ .
- ์ธํ๋ผ ๋น์ฉ: ์ฐจ๋โ์ธก ์ฅ๋น๊ฐ ํ์ ์์ผ๋ฏ๋ก ๊ธฐ์กด ๋๋ก๋ณ ์ธํ๋ผ(์ ์ ์ฃผยท์ ์) ํ์ฉํด ์ด๊ธฐ ํฌ์๋น์ฉ ์ ๊ฐ.
- ํ์คํ: ์ธํ๋ผโ์ค์ฌ FSP ๊ตฌํ์ ์ํ ์ผ์ยทํต์ ยท๋ฐ์ดํฐ ํฌ๋งท ๊ฐ์ด๋๋ผ์ธ ์ ์, ํฅํ ์ค๋งํธ ์ํฐยทITS ํ์คํ์ ๊ธฐ์ฌ ๊ฐ๋ฅ.
**
๐ Content
๋๋ก๋ณ์์ ๋ผ์ดํธ ๋ํ ์ ์ค ๋ ์ธ์ง(LiDAR)๊ณผ ์นด๋ฉ๋ผ๋ฅผ ์ด์ฉํ ์ผ์ฑ์ ๊ตํต ๋ชจ๋ํฐ๋งยทํ๋ ์ธ์ ๋ฑ ๊ตํต ๋ถ์ผ์์ ์ ์ ๋ ๋ง์ ๊ด์ฌ์ ๋ฐ๊ณ ์๋ค. ๋ณธ ์ฐ๊ตฌ์์๋ ํ๋ฌผ ์ ํธ ์ฐ์ (FSP) ์์คํ ์ ์ด์ ์ ๋ง์ถ์ด, ์ธํ๋ผ ๊ธฐ๋ฐ ์ผ์ฑ์ ํ์ฉํด ์ฐ์ ์์ฒญ์ ์ํ ์ฐจ๋ ๋์ฐฉ ์์ ์๊ฐ(ToA)์ ์ถ์ ํ๋ค.
FSP๋ ์ ํธ๋ฑ์ด ์ค์น๋ ๊ต์ฐจ๋ก์์ ํธ๋ญ์ ์ด๋์ฑ์ ํฅ์์ํค๋ ๋์์, ์ ์ฐจยท์ถ๋ฐ ๊ตฌ๊ฐ์์ ๋ํ๋๋ ํธ๋ญ์ ๋๋ฆฐ ๊ฐ์๊ณผ ๋์ ์ฐ๋ฃ ๋น์ฉ์ ๊ณ ๋ คํ๋ค. ์ ์ฒด ์ฐจ๋ ์ค ์ฝโฏ9โฏ%ยท์ ์ฒด ์ฐจ๋ ๋ง์ผ(VMT) ์ค ์ฝโฏ17โฏ%๋ง ์ฐจ์งํ์ง๋ง, ์คยท๋ํ ํธ๋ญ์ ์ ์ฒด ์๋ช ์ฃผ๊ธฐ ์จ์ค๊ฐ์ค(GHG) ๋ฐฐ์ถ๋์ ์ฝโฏ39โฏ%๋ฅผ ์ฐจ์งํ๋ค(Moultak etโฏal.,โฏ2017). EcoโFSP ์ ๊ทผ๋ฒ์ ๋คํธ์ํฌ ์ ์ฒด ์ฐ๋ฃ ์๋น๋ฅผ 5โ10โฏ% ์ ๊ฐํ๊ณ , ์ฌํ ์๊ฐ์ ์ต๋โฏ26โฏ% ๋จ์ถํ์ผ๋ฉฐ, ์ฐ๊ฒฐ ํธ๋ญ ์์คํ ์ ์ฐ๋ฃ์ COโ ๋ฐฐ์ถ์ ์ต๋โฏ25.3โฏ%๊น์ง ๊ฐ์์์ผฐ๋ค(Kari etโฏal.,โฏ2014; Park etโฏal.,โฏ2019). ๊ทธ๋ฌ๋ V2I/V2V ํต์ ์ ์์กดํ๋ ๊ตฌํ์ ์ฐจ๋์ ํ์ฌ ์ฅ๋น๊ฐ ํ์ํ๋ฏ๋ก ์ค์ ์ ์ฉ์ด ์ ํ๋๋ค.
์ด๋ฌํ ๋ฌธ์ ๋ฅผ ํด๊ฒฐํ๊ณ ์ ์ฐ๋ฆฌ๋ LiDAR์ ์นด๋ฉ๋ผ๋ฅผ ๊ฒฐํฉํ ์ธํ๋ผ ๊ธฐ๋ฐ ๋ค์ค ๋ชจ๋ฌ ํ๋ฌผ ์ฐจ๋ ํ์ง ์์คํ ์ ๊ฐ๋ฐํ์๋ค. ์์คํ ์ ํ์ฅ๋ณ ์งํ ์ ์ฝ์ ๋ง์ถฐ ๋ ๊ฐ์ ์๋ธ์์คํ ์ผ๋ก ๊ตฌ์ฑํ๋ค.
- ๊ต์ฐจ๋ก์ ์ค์น๋ ์ฅ๊ฑฐ๋ฆฌ LiDARยท์นด๋ฉ๋ผ ์๋ธ์์คํ
- ๋๋ก ๊ณก๋ฅ ์ ์ํด ์์ผ๊ฐ ์ฐจ๋จ๋๋ ๊ฒ์ ๋ณด์ํ๊ธฐ ์ํด ์ค๊ฐ ๊ตฌ๊ฐ์ ์ค์น๋ ์ค๊ฑฐ๋ฆฌ LiDARยท์นด๋ฉ๋ผ ์๋ธ์์คํ .
๋ฌด์ ํต์ ์ ํตํด ์ค๊ฐ ๊ตฌ๊ฐ์์ ์ป์ ํ์ง ๊ฒฐ๊ณผ๋ฅผ ๊ต์ฐจ๋ก๋ก ์ ์กํ๊ณ , ๊ต์ฐจ๋ก์์๋ ์ด๋ฅผ ๊ธฐ๋ฐ์ผ๋ก ํ๋ฅ FSP ๋์์ ์ํํ๋ค.
๋ณธ ์ฐ๊ตฌ์ ์ฃผ์ ๊ธฐ์ฌ๋ ๋ค์๊ณผ ๊ฐ์ด ์์ฝ๋๋ค.
- ์ธํ๋ผ ๊ธฐ๋ฐ ๋ค์ค ๋ชจ๋ฌ ํ๋ฌผ ์ฐจ๋ ํ์ง ์์คํ ์ ๋ํ ์ค๊ณยท๊ตฌํยทํ๊ฐ ํ์ดํ๋ผ์ธ์ ์ ๋ฉด์ ์ผ๋ก ์ ์ํ์๋ค.
- ๊ต์ฐจ๋ก์ ๋๋ก ๊ณก๋ฅ ์ ์ํด ๋ฐ์ํ๋ ๊ฐ์์ฑ ์ ํ์ ๊ทน๋ณตํ๊ธฐ ์ํด ์ด์ค ์๋ธ์์คํ ํ์ง ๊ตฌ์กฐ๋ฅผ ์ ์ํ์๋ค.
- ๋ฐ์ดํฐ ์์งยท์ฒ๋ฆฌ ํ์ดํ๋ผ์ธ์ ๊ตฌ์ถํ๊ณ , ์ด๊ธฐ ํ์งยท์ถ์ ๊ฒฐ๊ณผ๋ฅผ ์์ฐยทํ๊ฐํ์๋ค.
- LiDAR์์ ์ถ์ถํ ์ขํ๋ฅผ ์ง์ค๋ฐํฑ ๊ธฐ์ค ํ๋ ์์ ์ ํฉ์์ผ ์ฐจ์ ์์ค์ ์ฐจ๋ ์์น ์ถ์ ์ ๊ฐ๋ฅํ๊ฒ ํ์๋ค.
์์คํ ๋ฐฐ์น์ ๊ตฌ์กฐ
๊ทธ๋ฆผโฏ1์ ๋ํ๋ ๋ฐ์ ๊ฐ์ด, FSP ์์คํ ์ ์ฃผ์ ๊ต์ฐจ๋ก์ ํด ๋ง์ดํธํ ์ผ์๋ฅผ ์ค์นํด ๋ ๋ฐฉํฅ(๋จ๋ถ)์ผ๋ก ์ฅ๊ฑฐ๋ฆฌ ์ปค๋ฒ๋ฆฌ์ง๋ฅผ ์ ๊ณตํ๋ค. ๊ทธ๋ฌ๋ ํ์ชฝ ๋ฐฉํฅ์ ๋๋ก ๊ณก๋ฅ ๋๋ฌธ์ ๋ถ๋ถ์ ์ธ ๊ฐ๋ฆผ ํ์์ด ๋ฐ์ํด ์๊ฑฐ๋ฆฌ ๊ฐ์์ฑ์ด ์ ํ๋๋ค. ์ด๋ฅผ ๋ณด์ํ๊ธฐ ์ํด ๊ธฐ์กด ํดยท์บ๋น๋์ ํ์ฉํด ์ค๊ฐ ๊ตฌ๊ฐ์ ์ค๊ฑฐ๋ฆฌ ํ์ง ์๋ธ์์คํ ์ ์ค์นํ๊ณ , ํ๋ฌผ ์ฐจ๋์ ๋ณด๋ค ์์ ๊ฐ์งํ๋ค. ์ด ๋ ์ง์ ๊ฐ์๋ ์ ๋ขฐ์ฑ ๋์ ๋ฌด์ ํต์ ์ด ์ถ๊ฐ๋ก ์๊ตฌ๋๋ค. ๊ตฌ์ฒด์ ์ผ๋ก ๊ทธ๋ฆผโฏ1(c)๋ ์งํ๊ณผ ์๋ธ์์คํ ๋ฐฐ์น๋ฅผ ์กฐ๊ฐ๋๋ก ๋ณด์ฌ์ค๋ค.
์์คํ ์ ๋ ์๋ธ์์คํ (๊ต์ฐจ๋ก์ ์ค๊ฐ ๊ตฌ๊ฐ)์ผ๋ก ๊ตฌ์ฑ๋๋ค(๊ทธ๋ฆผโฏ2). ๊ต์ฐจ๋ก์๋ ์ฅ๊ฑฐ๋ฆฌ ๊ณ ์ ์ LiDAR(LivoxโฏTELEโ15)์ ์นด๋ฉ๋ผ๊ฐ ์์ ์ด๋ฃจ์ด ๋จํฅ ์ฐจ์ ์ ๋ชจ๋ํฐ๋งํ๋ค. ๋๋ก์ ์ํ ๊ณก๋ฅ ์ ์ํด ๋ฐ์ํ๋ ๊ฐ๋ฆผ์ ํด์ํ๊ธฐ ์ํด, ์ค๊ฐ ๊ตฌ๊ฐ์๋ ์ค๊ฑฐ๋ฆฌ ๊ธฐ๊ณ์ LiDAR(RobosenseโฏRubyโฏPlus)์ ์นด๋ฉ๋ผ๊ฐ ์ค์น๋์ด ์ ๊ทผ ์ฐจ๋์ ์ง์์ ์ผ๋ก ํ์งํ๋ค. ๋ ์๋ธ์์คํ ๊ฐ ๋ฐ์ดํฐ ์ ์ก์ UbiquitiโฏAirFiberโฏ5XHD ๋ฌด์ ๋ธ๋ฆฌ์ง๋ฅผ ํตํด ์ด๋ฃจ์ด์ง๋ค.
์ค๊ฐ ๊ตฌ๊ฐ ํ์ง ์ ๋์ ๋จ์ชฝ์์ ์ ๊ทผํ๋ ์ฐจ๋์ ๊ฐ์ํ๋ค. ๊ตฌ์ฑ ์์๋ ํ์ง ์ผ์ยทPoE ์ค์์นยท์ฃ์ง ์ปดํจํฐยท์ ๋์ ๋ฌด์ ์ก์ ๊ธฐ๋ก ์ด๋ฃจ์ด์ง๋ค. ์ฃ์ง ์ปดํจํฐ๋ LiDAR ํฌ์ธํธ ํด๋ผ์ฐ๋๋ฅผ ํ์ฅ์์ ์ฒ๋ฆฌํด ์ฐจ๋ ํ์ง ๊ฒฐ๊ณผ๋ฅผ ์์ฑํ๊ณ , ์ด๋ฅผ PTP(Precision Time Protocol) ๊ธฐ๋ฐ ๋ฌด์ ๋ธ๋ฆฌ์ง๋ก ๊ต์ฐจ๋ก์ ์ ์กํ๋ค(์๊ฐ ๋๊ธฐํ๋ PTP ์ฌ์ฉ, Cho etโฏal.,โฏ2009). ๊ต์ฐจ๋ก์ ์ฃ์ง ์ปดํจํฐ๋ ์์ชฝ ๋ฐฉํฅ์์ ๋ค์ด์ค๋ ํ์ง ์ ๋ณด๋ฅผ ์ข ํฉํด ๊ตํต ์ ์ด๊ธฐ์ ํ๋ฌผ ์ฐ์ ์์ฒญ์ ์์ฑํ๋ค.
๊ทธ๋ฆผโฏ3์ LiDARยท์นด๋ฉ๋ผยทAirFiber๊ฐ PoE ์ค์์น๋ฅผ ํตํด ์ ์ยท๋ฐ์ดํฐ๋ฅผ ๊ณต๊ธ๋ฐ๋ ๊ตฌ์ฑ์ ๋ณด์ฌ์ค๋ค. LiDAR๋ PoE๋ฅผ ์ง์ ์ง์ํ์ง ์์ผ๋ฏ๋ก PoE ์คํ๋ฆฌํฐ๋ฅผ ์ฌ์ฉํด ์ ์๊ณผ ๋ฐ์ดํฐ๋ฅผ ํ๋์ ์ผ์ด๋ธ์ ๊ฒฐํฉํ๋ค. ์นด๋ฉ๋ผ ์ด๋ฏธ์ง์ LiDAR ํฌ์ธํธ ํด๋ผ์ฐ๋๋ PoE ์ค์์น๋ฅผ ๊ฑฐ์ณ ์ฃ์ง ์ปดํจํฐ๋ก ์ ์ก๋๋ค. AirFiber ๋งํฌ๋ ์ฃผ๋ก ํ์ง ๊ฒฐ๊ณผ ์ ์ก์ ์ฌ์ฉ๋๋ฉฐ, ๋ณธ ๋ ผ๋ฌธ์์๋ ์์ธํ ๋ค๋ฃจ์ง ์๋๋ค.
๋ฐ์ดํฐ ์์ง
์นด๋ฉ๋ผยทLiDAR ๋ฐ์ดํฐ๋ ROS2 ๊ธฐ๋ฐ์ผ๋ก ์์ง๋๋ฉฐ, ํ์์คํฌํ๋ ์์คํ ์๊ณ์ ๋๊ธฐํ๋๋ค. ๊ทธ๋ฆผโฏ4๋ ๊ต์ฐจ๋ก์ ์ค๊ฐ ๊ตฌ๊ฐ์์ ์์ง๋ ์์ ๋ฐ์ดํฐ๋ฅผ ๋ณด์ฌ์ค๋ค. ๋ ์ฅ์ ๋ชจ๋ ์ด๋ฏธ์ง์ ํฌ์ธํธ ํด๋ผ์ฐ๋์ ํ๋ฌผ ์ฐจ๋์ด ๋ช ํํ ๋ํ๋๋ค.
GPS ๋ณด์
LiDAR ํฌ์ธํธ ํด๋ผ์ฐ๋๋ฅผ ์ ์ญ ์ขํ(์๋ยท๊ฒฝ๋)์ ์ ํฉํ๊ธฐ ์ํด GPS ๋ณด์ ์ ์ํํ๋ค. OXTSโฏAV200 GNSS ์ ๋์ ํ ์ํโฏCorolla์ ์ฅ์ฐฉํ๊ณ , GPS ๋ฐ์ดํฐ์ LiDARยท์นด๋ฉ๋ผ ๋ฐ์ดํฐ๋ฅผ ๋์์ ๊ธฐ๋กํ๋ค. LiDAR๋ ์ง์ค๋ก์ผ์ด์ ์ ํฉ์ ์ฌ์ฉ๋๊ณ , ์นด๋ฉ๋ผ ์ด๋ฏธ์ง๋ ํฌ์ธํธ ํด๋ผ์ฐ๋ ๋ด ์ฐจ๋์ ์๋ณํ๋ ๋ฐ ํ์ฉํ๋ค. ์ ์ ๊ธฐ์ค์ ๊ณผ ์ฐ์ ๊ถค์ ๋ฐ์ดํฐ๋ฅผ ๋ชจ๋ ์์งํ์ฌ ๋ณด์ ์ ์ด์ฉํ๋ค(๊ทธ๋ฆผโฏ5). ์์ง๋ ํ์ฅ ๋ฐ์ดํฐ๋ฅผ ๋ฐํ์ผ๋ก ์์ฉ ํ์งยท์ถ์ ์๊ณ ๋ฆฌ์ฆ์ ํ๊ฐํ๋ค. ๋ฅ๋ฌ๋ ๊ธฐ๋ฐ ํ์ง๊ธฐ์ ๊ธฐ์กด LiDARโonly ๋ฐฉ๋ฒ์ ๋น๊ตํ์ง๋ง, NuScenes(Caesar etโฏal.,โฏ2020)์์ ํ์ต๋ PointPillars(Lang etโฏal.,โฏ2019)์ ๊ฐ์ ์ฌ์ ํ์ต ๋ชจ๋ธ์ ์ค์บ ํจํด์ด ๋ค๋ฅธ ๊ณ ์ ์ LiDAR์ ๋ํด ์ผ๋ฐํ๋์ง ๋ชปํ๋ค. ๋ฐ๋ผ์ ๋ณธ ์ฐ๊ตฌ์์๋ ๊ฐ๋จํ ํธ๋ํน ์๊ณ ๋ฆฌ์ฆ์ ๊ฒฐํฉํ ์ ํต์ ์ธ LiDAR ๊ธฐ๋ฐ ํ์ง๊ธฐ๋ฅผ ์ฑํํ๋ค.
ํ์งยท์ถ์ ํ์ดํ๋ผ์ธ
ํ์ดํ๋ผ์ธ์ ๊ทธ๋ฆผโฏ6์ ์์ฝ๋๋ค. ์์ ํฌ์ธํธ ํด๋ผ์ฐ๋๋ ์ง๋ฉด ์ ๋ ฌ, ROI(๊ด์ฌ ์์ญ) ์ ๋จ, ๋ ธ์ด์ฆ ์ ๊ฑฐ, ๋ค์ด์ํ๋ง ๊ณผ์ ์ ๊ฑฐ์ณ ํจ์จ์ฑ์ ๋์ธ๋ค. ์ ๊ฒฝ ํฌ์ธํธ๋ ์คํ๋ผ์ธ ๋ฐฐ๊ฒฝ ๋งต์ ๋นผ์ ์ถ์ถํ๊ณ , DBSCAN(Ester etโฏal.,โฏ1996)์ผ๋ก ํด๋ฌ์คํฐ๋งํ๋ค.
ํ์ง์ ๋ถ๋ฅ๋ ํ๋ ์ ๋จ์ ๊ฒฐ๊ณผ์ ๋ค์ค ํ๋ ์ ํธ๋ํน์ ๋ชจ๋ ํ์ฉํ๋ค. ํ๋ ์ ๊ฐ ํธ๋ํน์ ํตํด ์ด๋ ๋ฐฉํฅ์ ์ถ์ ํ๊ณ , ํธ๋ญ์ ์๋ณํ๋ฉฐ, ์ถ์ ๋ ์๋๋ฅผ ๊ธฐ๋ฐ์ผ๋ก ToA๋ฅผ ๊ณ์ฐํ๋ค.
ํด๋ผ์ฐ๋ ํ์ ๋ณด์
๋๋ก๋ณ์ ์ค์น๋ LiDAR๋ ๋กคยทํผ์น๊ฐ 0์ด ์๋๋ฏ๋ก ์์ ํฌ์ธํธ ํด๋ผ์ฐ๋๊ฐ ๊ธฐ์ธ์ด ๋ณด์ธ๋ค. z์ถ์ ์์ง์ผ๋ก ๋ง์ถ๊ณ ํ์ ์ฒ๋ฆฌ๋ฅผ ๊ฐ๋ฅํ๊ฒ ํ๊ธฐ ์ํด ํ์ ๋ณด์ ์ ์ ์ฉํ๋ค. ๋กคโฏฯ์ ํผ์นโฏฮธ๋ฅผ ์ด์ฉํ ํ์ ํ๋ ฌ์ ๋ค์๊ณผ ๊ฐ๋ค.
[ R_{\text{pitch}}= \begin{bmatrix} \cos\theta & 0 & \sin\theta\ 0 & 1 & 0\ -\sin\theta & 0 & \cos\theta \end{bmatrix}, \qquad R_{\text{roll}}= \begin{bmatrix} 1 & 0 & 0\ 0 & \cos\phi & -\sin\phi\ 0 & \sin\phi & \cos\phi \end{bmatrix} ]
ํผ์น๊ฐ ๋๋ก๋ณ ์ค์น์์ ์ฃผ๋ก ์ฐ์ธํ๋ฏ๋ก ํผ์น โ ๋กค ์์๋ก ๋ณด์ ํ๋ค.
[ p’ = R_{\text{roll}},R_{\text{pitch}},p ]
๋ณด์ ๋ ํฌ์ธํธ ํด๋ผ์ฐ๋ (p’)๋ z์ถ์ด ์์ง์ธ ํํํ ํํ๊ฐ ๋๋ฉฐ, ์ด๋ ๋์ด ์ผ๊ด์ฑ์ ํฅ์์์ผ ํธ๋ญยท์๋์ฐจ ๊ตฌ๋ถ์ ๋ณด๋ค ์ ๋ขฐ์ฑ ์๊ฒ ๋ง๋ ๋ค(๊ทธ๋ฆผโฏ7).
์ฐจ๋ ํน์ง ์ถ์ถ
ํด๋ฌ์คํฐ์ ์ต๋ ๋์ด์ ์์ง ๋ณ๋์ ์ด์ฉํด ์ฐจ๋์ ๋ถ๋ฅํ๋ค.
[ h_{\max} = \max_{p \in C_k} z_p,\qquad \Delta h = \max_{p \in C_k} z_p - \min_{p \in C_k} z_p ]
์ด๋ฌํ ํน์ง์ ์ดํ ์ฐจ๋ ๋ถ๋ฅยทํธ๋ํน์ ํ์ฉ๋๋ค.
๊ฐ์ฒด ํธ๋ํน
๊ฐ์ฒด ํธ๋ํน์ ์ํด 6์ฐจ์(์์นยท์๋ยท๊ฐ์๋) ์์ ์๋ ์นผ๋ง ํํฐ๋ฅผ ์ ์ฉํ๋ค(Welch,โฏ1995).
[ \mathbf{w}_k,\ \mathbf{v}_k \text{๋ ๊ฐ๊ฐ ํ๋ก์ธ์ค ๋ ธ์ด์ฆ(๊ฐ์ยท์ด๋ ๋ถํ์ค์ฑ)์ ์ธก์ ๋ ธ์ด์ฆ(LiDAR ์ธก์ )์ด๋ฉฐ,} ] [ \mathbf{Q}= \operatorname{cov}(\mathbf{w}_k),\quad \mathbf{R}= \operatorname{cov}(\mathbf{v}_k) ]
๊ฐ ํ๋ ์์์ ํํฐ๋ ๋จผ์ ์ด๋ ๋ชจ๋ธ์ ๋ฐ๋ผ ์์ธกํ๋ค.
[ \mathbf{x}{k|k-1}= \mathbf{A}\mathbf{x}{k-1|k-1}+ \mathbf{w}k,\qquad \mathbf{P}{k|k-1}= \mathbf{A}\mathbf{P}_{k-1|k-1}\mathbf{A}^\top + \mathbf{Q} ]
๊ทธ ํ ์๋ก์ด ์ธก์ ๊ฐ์ผ๋ก ์ํ๋ฅผ ์ ๋ฐ์ดํธํ๋ค.
[ \mathbf{K}k = \mathbf{P}{k|k-1}\mathbf{H}^\top (\mathbf{H}\mathbf{P}{k|k-1}\mathbf{H}^\top + \mathbf{R})^{-1} ] [ \mathbf{x}{k|k}= \mathbf{x}_{k|k-1}+ \mathbf{K}k(\mathbf{z}k - \mathbf{H}\mathbf{x}{k|k-1}) ] [ \mathbf{P}{k|k}= (\mathbf{I} - \mathbf{K}k\mathbf{H})\mathbf{P}{k|k-1} ]
GPSโLiDAR ์ ํฉ ํ์ดํ๋ผ์ธ
์ ํฉ ํ์ดํ๋ผ์ธ์ ๊ทธ๋ฆผโฏ12์ ์ ์๋๋ค. LiDAR ํ๋ ์โฏL๊ณผ ์ ์ญ ENU ํ๋ ์โฏE ์ฌ์ด์ ์ด๊ธฐ ์ธ๋ถ ๋ณํ์ ๊ตฌํ๊ธฐ ์ํด GPS์ LiDAR ๋ก๊ทธ์์ ์ ์ ๊ตฌ๊ฐ์ ์ถ์ถํ๋ค. GPS ์์น๋ฅผ ENU ์ขํ๊ณ๋ก ๋ณํํ๊ณ , ํด๋น ์์ LiDAR ํด๋ผ์ฐ๋์์ ์ ์ ๋ชฉํ๋ฌผ์ ์๋์ผ๋ก ๋ผ๋ฒจ๋งํ๋ค. N๊ฐ์ ๋์ ์ ({(\mathbf{p}^{\text{GPS}}_i,\ \mathbf{p}^{\text{LiDAR}}i)}{i=1}^{N})์ ๋ํด ์ โ๋โ์ ๋ฑ๋ก์ ์ํํ๋ค.
[ \min_{\mathbf{R},\mathbf{t}} \sum_{i=1}^{N}| \mathbf{p}^{\text{GPS}}_i - (\mathbf{R}\mathbf{p}
์ด ๊ธ์ AI๊ฐ ์๋ ๋ฒ์ญ ๋ฐ ์์ฝํ ๋ด์ฉ์ ๋๋ค.