๐Ÿšš๐Ÿšฆ โ€œ๋„๋กœ๋ณ€ ๋ˆˆยท์นด๋ฉ”๋ผยทAI๊ฐ€ ๋งŒ๋‚œ๋‹ค! ์ธํ”„๋ผ ๊ธฐ๋ฐ˜ ํ™”๋ฌผ์ฐจ ์‹ ํ˜ธ์šฐ์„ (โ€‹FSP) ์‹ค์‹œ๊ฐ„ ํƒ์ง€ ์‹œ์Šคํ…œโ€

์ฝ๋Š” ์‹œ๊ฐ„: 9 ๋ถ„
...

๐Ÿ“ 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. ์‹œ์Šคํ…œ ์„ค๊ณ„ยท๊ตฌํ˜„

๊ตฌ์„ฑ ์š”์†Œ๊ต์ฐจ๋กœ ์„œ๋ธŒ์‹œ์Šคํ…œ์ค‘๊ฐ„โ€‘๊ตฌ๊ฐ„ ์„œ๋ธŒ์‹œ์Šคํ…œ
LiDARLivoxโ€ฏTELEโ€‘15 (๊ณ ์ •์‹, ์žฅ๊ฑฐ๋ฆฌ)Robosenseโ€ฏRubyโ€ฏPlus (๊ธฐ๊ณ„์‹, ์ค‘๊ฑฐ๋ฆฌ)
CameraRGBโ€ฏ(์ผ๋ฐ˜)RGBโ€ฏ(์ผ๋ฐ˜)
Edge ์ปดํ“จํŒ…ROS2 + GPU(์˜ต์…˜)ROS2 + GPU(์˜ต์…˜)
ํ†ต์‹ Ubiquitiโ€ฏAirFiberโ€ฏ5XHD (PTP)๋™์ผ
์ „์›PoE ์Šค์œ„์น˜ + PoEโ€‘Splitter๋™์ผ
  • ์ด์ค‘โ€‘์„œ๋ธŒ์‹œ์Šคํ…œ์€ ๋„๋กœ ๊ณก๋ฅ ์— ์˜ํ•œ ์‹œ์•ผ ์ฐจ๋‹จ์„ ๋ณด์™„ํ•œ๋‹ค๋Š” ์ ์—์„œ ์‹ค์šฉ์ ์ด๋ฉฐ, ๊ธฐ์กด ์ธํ”„๋ผ(์ „์‹ ์ฃผยท์บ๋น„๋‹›)๋ฅผ ์žฌํ™œ์šฉํ•ด ์„ค์น˜ ๋น„์šฉ์„ ์ตœ์†Œํ™”ํ•œ๋‹ค.
  • ์‹œ๊ฐ„ ๋™๊ธฐํ™”๋Š” Precision Time Protocol(PTP)์œผ๋กœ ๊ตฌํ˜„ํ•ด ์„ผ์„œ ๊ฐ„ยท์‹œ์Šคํ…œ ๊ฐ„ ์ง€์—ฐ์„ <โ€ฏ1โ€ฏms ์ˆ˜์ค€์œผ๋กœ ์–ต์ œ, ToA ๊ณ„์‚ฐ ์ •ํ™•์„ฑ์„ ํ™•๋ณดํ•œ๋‹ค.

3. ์ธ์‹ ํŒŒ์ดํ”„๋ผ์ธ

  1. ์ „์ฒ˜๋ฆฌ
    • ์ง€๋ฉด ๋ณด์ • โ†’ ROI(๊ด€์‹ฌ ์˜์—ญ) ์ ˆ๋‹จ โ†’ ํฌ์ธํŠธ ํด๋ผ์šฐ๋“œ ๋‹ค์šด์ƒ˜ํ”Œ๋ง(Voxel Grid)
  2. ๋ฐฐ๊ฒฝ ์ฐจ๊ฐ
    • ์‚ฌ์ „ ๊ตฌ์ถ•ํ•œ ์ •์  ๋ฐฐ๊ฒฝ ๋งต์„ ๋นผ์„œ ์ „๊ฒฝ ํฌ์ธํŠธ๋งŒ ๋‚จ๊น€(์‹ค์‹œ๊ฐ„ ๋ฐฐ๊ฒฝ ์—…๋ฐ์ดํŠธ๋Š” ๋ฏธ๊ตฌํ˜„)
  3. ํด๋Ÿฌ์Šคํ„ฐ๋ง
    • DBSCAN(ฮต, MinPts) ๊ธฐ๋ฐ˜ 3โ€‘D ๊ตฐ์ง‘ํ™” โ†’ ๊ฐ ๊ตฐ์ง‘์˜ ์ค‘์‹ฌยท์ตœ๋Œ€ ๋†’์ดยท๋†’์ด ๋ณ€๋™๋Ÿ‰ ๊ณ„์‚ฐ
  4. ํ™”๋ฌผ์ฐจ ๊ตฌ๋ถ„
    • ๋†’์ด ๊ธฐ๋ฐ˜: maxโ€‘heightโ€ฏ>โ€ฏ2.5โ€ฏm โ†’ ํŠธ๋Ÿญ ํ›„๋ณด
    • ํ˜•ํƒœ ๊ธฐ๋ฐ˜: ๋†’์ด ๋ณ€๋™๋Ÿ‰โ€ฏ>โ€ฏ0.5โ€ฏm โ†’ ์žฅ/์†Œํ˜• ํŠธ๋Ÿญ ๊ตฌ๋ถ„ (๊ฑฐ๋ฆฌ ์ž„๊ณ„๊ฐ’ ์ ์šฉ)
  5. ํŠธ๋ž˜ํ‚น
    • 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. ๊ฐ•์  ๋ฐ ๊ธฐ์—ฌ

  1. ํ˜„์žฅ ๋งž์ถคํ˜• ์ด์ค‘โ€‘์„œ๋ธŒ์‹œ์Šคํ…œ ์„ค๊ณ„ โ€“ ๊ณก์„ ยท์‹œ์•ผ ์ฐจ๋‹จ ๋ฌธ์ œ๋ฅผ ํ•˜๋“œ์›จ์–ด ์ˆ˜์ค€์—์„œ ํ•ด๊ฒฐ.
  2. ๋ผ์ด๋‹คโ€‘์ „์šฉ ํด๋Ÿฌ์Šคํ„ฐโ€‘ํŠธ๋ž˜ํ‚น ํŒŒ์ดํ”„๋ผ์ธ โ€“ ๋”ฅ๋Ÿฌ๋‹ ๋ผ๋ฒจ๋ง ๋น„์šฉ ์—†์ด๋„ ์‹ค์‹œ๊ฐ„ FSP ๊ตฌํ˜„ ๊ฐ€๋Šฅ.
  3. ์ „์—ญ ์ขŒํ‘œ ์ •ํ•ฉ์„ ํ†ตํ•œ ์ฐจ์„ โ€‘์ˆ˜์ค€ ๋กœ์ปฌ๋ผ์ด์ œ์ด์…˜ โ€“ ๊ธฐ์กด ๋„๋กœ๋ณ€ ์„ผ์„œ๊ฐ€ ์ œ๊ณตํ•˜์ง€ ๋ชปํ•œ ์ •๋ฐ€๋„ ํ™•๋ณด.
  4. **์‹œ์Šคํ…œโ€‘๋ ˆ๋ฒจ ํ†ตํ•ฉ(์„ผ์„œยทํ†ต์‹ ยท์‹œ๊ฐ„๋™๊ธฐํ™”ยท์—ฃ์ง€ ์ปดํ“จํŒ…)**์„ ์‹ค์ œ ๊ต์ฐจ๋กœ์— ๋ฐฐ์น˜ยท์šด์šฉํ•œ ์ตœ์ดˆ ์‚ฌ๋ก€ ์ค‘ ํ•˜๋‚˜.

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์™€ ์นด๋ฉ”๋ผ๋ฅผ ๊ฒฐํ•ฉํ•œ ์ธํ”„๋ผ ๊ธฐ๋ฐ˜ ๋‹ค์ค‘ ๋ชจ๋‹ฌ ํ™”๋ฌผ ์ฐจ๋Ÿ‰ ํƒ์ง€ ์‹œ์Šคํ…œ์„ ๊ฐœ๋ฐœํ•˜์˜€๋‹ค. ์‹œ์Šคํ…œ์€ ํ˜„์žฅ๋ณ„ ์ง€ํ˜• ์ œ์•ฝ์— ๋งž์ถฐ ๋‘ ๊ฐœ์˜ ์„œ๋ธŒ์‹œ์Šคํ…œ์œผ๋กœ ๊ตฌ์„ฑํ•œ๋‹ค.

  1. ๊ต์ฐจ๋กœ์— ์„ค์น˜๋œ ์žฅ๊ฑฐ๋ฆฌ LiDARยท์นด๋ฉ”๋ผ ์„œ๋ธŒ์‹œ์Šคํ…œ
  2. ๋„๋กœ ๊ณก๋ฅ ์— ์˜ํ•ด ์‹œ์•ผ๊ฐ€ ์ฐจ๋‹จ๋˜๋Š” ๊ฒƒ์„ ๋ณด์™„ํ•˜๊ธฐ ์œ„ํ•ด ์ค‘๊ฐ„ ๊ตฌ๊ฐ„์— ์„ค์น˜๋œ ์ค‘๊ฑฐ๋ฆฌ 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๊ฐ€ ์ž๋™ ๋ฒˆ์—ญ ๋ฐ ์š”์•ฝํ•œ ๋‚ด์šฉ์ž…๋‹ˆ๋‹ค.

๊ฒ€์ƒ‰ ์‹œ์ž‘

๊ฒ€์ƒ‰์–ด๋ฅผ ์ž…๋ ฅํ•˜์„ธ์š”

โ†‘โ†“
โ†ต
ESC
โŒ˜K ๋‹จ์ถ•ํ‚ค