2025-11-22T12:28:16.211832

SVN-ICP: Uncertainty Estimation of ICP-based LiDAR Odometry using Stein Variational Newton

Ma, Zhang, Toussaint
This letter introduces SVN-ICP, a novel Iterative Closest Point (ICP) algorithm with uncertainty estimation that leverages Stein Variational Newton (SVN) on manifold. Designed specifically for fusing LiDAR odometry in multisensor systems, the proposed method ensures accurate pose estimation and consistent noise parameter inference, even in LiDAR-degraded environments. By approximating the posterior distribution using particles within the Stein Variational Inference framework, SVN-ICP eliminates the need for explicit noise modeling or manual parameter tuning. To evaluate its effectiveness, we integrate SVN-ICP into a simple error-state Kalman filter alongside an IMU and test it across multiple datasets spanning diverse environments and robot types. Extensive experimental results demonstrate that our approach outperforms best-in-class methods on challenging scenarios while providing reliable uncertainty estimates.
academic

SVN-ICP: Stein Variational Newton ব্যবহার করে ICP-ভিত্তিক LiDAR Odometry এর অনিশ্চয়তা অনুমান

মৌলিক তথ্য

  • পেপার ID: 2509.08069
  • শিরোনাম: SVN-ICP: Uncertainty Estimation of ICP-based LiDAR Odometry using Stein Variational Newton
  • লেখক: Shiping Ma (TU Berlin), Haoming Zhang (TU Munich), Marc Toussaint (TU Berlin)
  • শ্রেণীবিভাগ: cs.RO (রোবোটিক্স)
  • প্রকাশনা সময়/সম্মেলন: IEEE Robotics and Automation Letters, সেপ্টেম্বর ২০২৫ এ গৃহীত
  • পেপার লিঙ্ক: https://arxiv.org/abs/2509.08069

সারসংক্ষেপ

এই পেপারটি SVN-ICP প্রস্তাব করে, যা Stein Variational Newton (SVN) পদ্ধতি ব্যবহার করে manifold এ অনিশ্চয়তা অনুমানের জন্য একটি নতুন Iterative Closest Point (ICP) অ্যালগরিদম। এই পদ্ধতিটি বহু-সেন্সর সিস্টেমে LiDAR odometry সংমিশ্রণের জন্য ডিজাইন করা হয়েছে, এমনকি LiDAR অবনত পরিবেশেও নির্ভুল pose অনুমান এবং সামঞ্জস্যপূর্ণ noise প্যারামিটার অনুমান নিশ্চিত করে। Stein variational অনুমান কাঠামোর মধ্যে কণা approximation ব্যবহার করে, SVN-ICP স্পষ্ট noise মডেলিং বা ম্যানুয়াল প্যারামিটার সমন্বয়ের প্রয়োজনীয়তা দূর করে। লেখকরা SVN-ICP কে একটি সহজ error-state Kalman filter এ IMU এর সাথে একীভূত করেছেন এবং একাধিক পরিবেশ এবং রোবট প্রকার জুড়ে বিস্তৃত একাধিক ডেটাসেটে পরীক্ষা করেছেন। পরীক্ষামূলক ফলাফল দেখায় যে এই পদ্ধতিটি চ্যালেঞ্জিং পরিস্থিতিতে অত্যাধুনিক পদ্ধতির চেয়ে উন্নত, একই সাথে নির্ভরযোগ্য অনিশ্চয়তা অনুমান প্রদান করে।

গবেষণা পটভূমি এবং প্রেরণা

মূল সমস্যা

প্রথাগত ICP অ্যালগরিদম শুধুমাত্র বিন্দু অনুমান প্রদান করে, বহু-সেন্সর সংমিশ্রণের জন্য প্রয়োজনীয় অনিশ্চয়তা বৈশিষ্ট্যের অভাব রয়েছে। বিদ্যমান সংমিশ্রণ পদ্ধতিগুলি সাধারণত স্থির heuristic নিয়ম এবং সেন্সর noise, জ্যামিতি বা স্ক্যান convergence এর উপর ভিত্তি করে হাতে তৈরি noise মডেলের উপর নির্ভর করে।

সমস্যার গুরুত্ব

রোবোটিক্স নেভিগেশনে, নির্ভুল অনিশ্চয়তা অনুমান robust state অনুমানের জন্য অত্যন্ত গুরুত্বপূর্ণ, বিশেষ করে LiDAR অবনত পরিবেশে (যেমন ধুলোময় গুহা, করিডোর ইত্যাদি জ্যামিতিগতভাবে অবনত দৃশ্য)। এই পরিবেশগুলিতে একই সাথে একাধিক অনিশ্চয়তার উৎস থাকতে পারে, যা অনিশ্চয়তা মডেলিংকে একটি চ্যালেঞ্জিং সমস্যা করে তোলে।

বিদ্যমান পদ্ধতির সীমাবদ্ধতা

  1. Stein ICP এর সীমাবদ্ধতা: প্রথম-ক্রম পদ্ধতি হিসাবে, ill-posed সমস্যায় দুর্বল কর্মক্ষমতা প্রদর্শন করে, ধীর convergence এবং step size এর প্রতি সংবেদনশীল
  2. Euclidean প্রতিনিধিত্ব সমস্যা: translation এবং rotation এর জন্য আলাদাভাবে gradient এবং kernel ডিজাইন গণনা করার প্রয়োজন, SE(3) manifold কাঠামো থেকে বিচ্যুত
  3. হাতে তৈরি noise মডেল: বিভিন্ন পরিবেশের সাথে খাপ খাওয়ানো কঠিন, প্রায়শই অত্যধিক আত্মবিশ্বাসী অনিশ্চয়তা অনুমানের দিকে পরিচালিত করে

গবেষণা প্রেরণা

এমন একটি পদ্ধতি বিকাশ করা যা স্পষ্ট অনিশ্চয়তা মডেলিং বা সনাক্তকরণ কৌশল ছাড়াই, non-parametric variational বিতরণের মাধ্যমে প্রাকৃতিকভাবে সরাসরি অনিশ্চয়তা পরিমাপ বের করতে পারে।

মূল অবদান

  1. উদ্ভাবনী অ্যালগরিদম: SVN-ICP প্রস্তাব করা হয়েছে, যা manifold এ Stein variational Newton পদ্ধতির উপর ভিত্তি করে একটি ICP LiDAR odometry পদ্ধতি, অন্তর্নির্মিত অনিশ্চয়তা পরিমাণীকরণ ক্ষমতা সহ
  2. ব্যাপক মূল্যায়ন: SVN-ICP কে Kalman filter এ একীভূত করে, দুটি চ্যালেঞ্জিং ডেটাসেটে অনুমানিত অনিশ্চয়তা মূল্যায়ন করা হয়েছে এবং অত্যাধুনিক পদ্ধতির সাথে benchmark করা হয়েছে
  3. দক্ষ বাস্তবায়ন: SVN এর জন্য early stopping প্রক্রিয়া বিকশিত করা হয়েছে, GPU সমর্থিত দক্ষ C++ বাস্তবায়ন প্রদান করা হয়েছে

পদ্ধতির বিস্তারিত বিবরণ

কাজের সংজ্ঞা

উৎস পয়েন্ট ক্লাউড P = {pₙ} এবং লক্ষ্য পয়েন্ট ক্লাউড Q = {qₙ} দেওয়া, এবং prior pose Ť এবং covariance Σ̌, posterior pose T̂ এবং covariance Σ̂ আউটপুট করুন।

মূল প্রযুক্তিগত কাঠামো

1. Manifold এ ICP

ডান-হাতের perturbation মডেল গ্রহণ করে, SE(3) manifold এ pose প্রতিনিধিত্ব করা হয়:

L(ξ) = Σₙ ||（exp(ϑ)pₙ + p) - qₙ||²

যেখানে ξ = p ϑᵀ ∈ R³×so(3) দুটি পয়েন্ট ক্লাউডের মধ্যে ন্যূনতম pose বৃদ্ধি প্রতিনিধিত্ব করে।

2. Stein Variational Newton পদ্ধতি

SVGD এর প্রথম-ক্রম gradient flow এর বিপরীতে, SVN Newton-সদৃশ আপডেট গণনা করতে দ্বিতীয়-ক্রম তথ্য একত্রিত করে:

SVGD আপডেট:

ϕ*(ξₖ) = (1/K) Σₗ [k(ξₗ,ξₖ)b(ξₖ) + ∇ξₗk(ξₗ,ξₖ)]

SVN আপডেট:

ξₖ ← ξₖ + H̃⁻¹ϕ*(ξₖ)

যেখানে preconditioned Hessian ম্যাট্রিক্স হল:

H̃(ξₖ) = (1/K) Σₗ [Hₖ(ξ)k(ξₗ,ξₖ)² + (∇ξₖk(ξₗ,ξₖ))⊗²]

3. অ্যালগরিদম প্রবাহ

  1. K টি perturbation কণা শুরু করুন
  2. KNN এর মাধ্যমে লক্ষ্য পয়েন্ট ক্লাউডের সংশ্লিষ্ট উপসেট খুঁজুন
  3. convergence পর্যন্ত বা early stopping শর্ত পূরণ পর্যন্ত SVN আপডেট পুনরাবৃত্তি করুন
  4. কণাগুলির মধ্যে গড় perturbation অবস্থা এবং covariance গণনা করুন
  5. সহায়ক রূপান্তর ব্যবহার করে covariance কে বৈশ্বিক সমন্বয় ব্যবস্থায় প্রচার করুন

প্রযুক্তিগত উদ্ভাবন পয়েন্ট

  1. Manifold প্রতিনিধিত্ব: ডান-হাতের perturbation মডেল গ্রহণ করে, translation এবং rotation কে আরও ভালভাবে decoupling করে, সংখ্যাগত স্থিতিশীলতা উন্নত করে
  2. দ্বিতীয়-ক্রম অপ্টিমাইজেশন: SVN curvature তথ্য একত্রিত করে, ill-conditioned অবস্থায় আরও স্থিতিশীল এবং দ্রুত convergence প্রদান করে
  3. Voxel স্যাম্পলিং: mini-batch স্যাম্পলিং প্রতিস্থাপন করে, উচ্চতর variational অনুমান গুণমান নিশ্চিত করে একই সাথে গণনা খরচ উল্লেখযোগ্যভাবে হ্রাস করে
  4. Early stopping প্রক্রিয়া: কণা অবস্থা আপডেটের গড় norm পর্যবেক্ষণ করে, গণনা দক্ষতা উন্নত করে

পরীক্ষামূলক সেটআপ

ডেটাসেট

  • SubT-MRS ডেটাসেট: প্রধানত মিশ্র অভ্যন্তরীণ পরিবেশ অন্তর্ভুক্ত করে, UGV, ড্রোন, হ্যান্ডহেল্ড এবং পায়ে হাঁটা রোবট প্ল্যাটফর্ম জুড়ে বিস্তৃত
  • GEODE ডেটাসেট: চ্যালেঞ্জিং বহিরঙ্গন দৃশ্য অন্তর্ভুক্ত করে, যেমন ক্রস-কান্ট্রি ট্রেইল এবং জলপথ

মূল্যায়ন মেট্রিক্স

  • সাধারণ ত্রুটি মেট্রিক্স: Absolute Pose Error (APE), Relative Pose Error (RPE)
  • অনিশ্চয়তা গুণমান মেট্রিক্স: Kullback-Leibler divergence, Normalized Norm Error (NNE)

তুলনামূলক পদ্ধতি

  • সিস্টেম-স্তরের পদ্ধতি: Liu et al., Weitong et al., Kim et al., Zhong et al.
  • Odometry পদ্ধতি: LIO-EKF, KISS-ICP, GenZ-ICP, Stein ICP
  • এই পেপারের রূপান্তর: SVGD-ICP, SVN-ICP, SVN-ICP+KF

বাস্তবায়ন বিবরণ

  • 30 টি কণা ব্যবহার করুন, সর্বাধিক 100 পুনরাবৃত্তি
  • RBF kernel: k(ξₗ,ξₖ) = exp(1/h||ξₗ-ξₖ||₂²)
  • GPU ত্বরিত C++ বাস্তবায়ন, ROS2 ইন্টারফেস সমর্থন করে

পরীক্ষামূলক ফলাফল

প্রধান ফলাফল

SubT-MRS ডেটাসেট কর্মক্ষমতা

11 টি পরীক্ষা ক্রম মধ্যে, SVN-ICP+KF একাধিক দৃশ্যে উৎকৃষ্ট কর্মক্ষমতা প্রদর্শন করে:

  • Urban ক্রম: APE 0.478m (vs baseline পদ্ধতি 0.307-13.16m)
  • Tunnel ক্রম: APE 0.085m, সেরা পদ্ধতির সাথে তুলনীয়
  • Cave ক্রম: APE 0.532m, বেশিরভাগ baseline পদ্ধতির চেয়ে উন্নত

GEODE ডেটাসেট কর্মক্ষমতা

  • Waterway Long ক্রম: APE 15.58m, স্থির noise প্যারামিটার সহ 36.80m এর তুলনায় উল্লেখযোগ্য উন্নতি
  • Bridge1 ক্রম: অত্যন্ত চ্যালেঞ্জিং বৈশিষ্ট্যহীন পুনরাবৃত্ত কাঠামোতে স্থিতিশীল থাকে (APE 44.27m)

অনিশ্চয়তা অনুমান গুণমান

Long Corridor ক্রমে 1000 Monte Carlo নমুনার সাথে তুলনা:

পদ্ধতিNNE(trans/rot)KL div.(trans/rot)
Censi101.2/336.61.0e5/2.8e5
COV-3D1.088/1.64412.68/385.8
SVN-ICP0.995/0.8521.532/41.72
SVN-ICP+KF0.939/0.6751.713/10.06

Ablation পরীক্ষা

Convergence বিশ্লেষণ

  • SVN-ICP 30-75 পুনরাবৃত্তির মধ্যে convergence করে
  • SVGD-ICP ধীর sawtooth convergence প্রদর্শন করে, প্রায়শই সম্পূর্ণ 100 পুনরাবৃত্তির প্রয়োজন

কণা সংখ্যার প্রভাব

  • 30 টি কণা নির্ভুলতা এবং দক্ষতার মধ্যে ভাল ভারসাম্য প্রদান করে
  • 5-10 টি কণা robust সেন্সর সংমিশ্রণের জন্য যথেষ্ট
  • চলার সময়: SVN-ICP (0.483s) vs SVGD-ICP (0.669s)

মূল আবিষ্কার

  1. অনিশ্চয়তা অভিযোজন: গতিশীল ICP noise প্যারামিটার আপডেট Kalman filter এর robustness উল্লেখযোগ্যভাবে উন্নত করে
  2. জ্যামিতিগত অবনতি পরিচালনা: করিডোরের মতো কাঠামোগত অবনত পরিবেশে, অনিশ্চয়তা অনুমান পরিবেশ কাঠামো এবং রোবট গতির সাথে সামঞ্জস্যপূর্ণ
  3. বহু-মোডাল বিতরণ: অনুমানিত অনিশ্চয়তা non-Gaussian বৈশিষ্ট্য প্রদর্শন করে, বহু-মোডাল এবং দীর্ঘ-লেজ বৈশিষ্ট্য সহ

সম্পর্কিত কাজ

LiDAR Odometry

  • বৈশিষ্ট্য-ভিত্তিক পদ্ধতি: বিরল জ্যামিতিক বৈশিষ্ট্য (প্রান্ত, সমতল) মেলানো
  • সরাসরি পদ্ধতি: ICP বা NDT ভিত্তিক কাঁচা পয়েন্ট ক্লাউড মেলানো
  • সংমিশ্রণ পদ্ধতি: IMU এর সাথে কঠোরভাবে যুক্ত Kalman filter স্কিম

অনিশ্চয়তা-সচেতন পদ্ধতি

  • অবনতি সনাক্তকরণ: সাধারণ ভেক্টর, স্ক্যান মেলানো অবশিষ্ট বা Hessian ম্যাট্রিক্স বিশ্লেষণ
  • অনিশ্চয়তা অনুমান: বন্ধ-ফর্ম covariance অনুমান, শেখা-ভিত্তিক পদ্ধতি, Bayesian ICP

Stein Variational অনুমান

  • SVGD: kernel Stein divergence ব্যবহার করে কণা variational অনুমান
  • SVN: দ্বিতীয়-ক্রম তথ্য একত্রিত করে Newton-সদৃশ আপডেট

উপসংহার এবং আলোচনা

প্রধান উপসংহার

  1. SVN-ICP সফলভাবে নির্ভুল pose অনুমান এবং সামঞ্জস্যপূর্ণ অনিশ্চয়তা পরিমাণীকরণ একত্রিত করে
  2. LiDAR অবনত পরিবেশে, অভিযোজিত অনিশ্চয়তা অনুমান সেন্সর সংমিশ্রণ কর্মক্ষমতা উল্লেখযোগ্যভাবে উন্নত করে
  3. দ্বিতীয়-ক্রম অপ্টিমাইজেশন পদ্ধতি ill-conditioned অবস্থায় উন্নত convergence এবং স্থিতিশীলতা প্রদর্শন করে

সীমাবদ্ধতা

  1. গতি অপর্যবেক্ষণীয়তা: বৈশিষ্ট্যহীন পরিবেশে আক্রমণাত্মক গতির সময় এখনও সীমাবদ্ধতা রয়েছে
  2. গতিশীল বস্তু: চলমান বস্তু সহ দৃশ্য গুরুতর মানচিত্র ক্ষতি হতে পারে
  3. সহজ কাঠামো: বর্তমান বাস্তবায়ন মৌলিক odometry ডিজাইন এবং সহজ Kalman filter ব্যবহার করে

ভবিষ্যত দিকনির্দেশনা

  1. সক্রিয় SLAM এর জন্য দক্ষ অনিশ্চয়তা-সচেতন LiDAR odometry
  2. kernel প্যারামিটারকরণের গবেষণা
  3. অন্যান্য দূরত্ব সেন্সরে সম্প্রসারণ (যেমন রাডার)

গভীর মূল্যায়ন

শক্তি

  1. তাত্ত্বিক উদ্ভাবন: SVN কে ICP সমস্যায় প্রবর্তন করে, নীতিগত অনিশ্চয়তা অনুমান পদ্ধতি প্রদান করে
  2. শক্তিশালী ব্যবহারযোগ্যতা: ম্যানুয়াল সমন্বয়ের প্রয়োজন নেই, শক্তিশালী অভিযোজনযোগ্যতা
  3. ব্যাপক পরীক্ষা: একাধিক চ্যালেঞ্জিং ডেটাসেটে ব্যাপক মূল্যায়ন পরিচালিত
  4. ওপেন সোর্স অবদান: দক্ষ C++ বাস্তবায়ন এবং GPU সমর্থন প্রদান করে

অপূর্ণতা

  1. গণনা জটিলতা: প্রথাগত ICP পদ্ধতির তুলনায় এখনও উচ্চ গণনা খরচ রয়েছে
  2. প্যারামিটার সংবেদনশীলতা: kernel bandwidth এর মতো প্যারামিটারের পছন্দ কর্মক্ষমতা প্রভাবিত করতে পারে
  3. অপর্যাপ্ত তাত্ত্বিক বিশ্লেষণ: convergence এবং অনিশ্চয়তা গুণমানের তাত্ত্বিক গ্যারান্টির অভাব

প্রভাব

  1. একাডেমিক মূল্য: SLAM ক্ষেত্রে অনিশ্চয়তা অনুমানের জন্য নতুন চিন্তাভাবনা প্রদান করে
  2. ব্যবহারিক মূল্য: বহু-সেন্সর সংমিশ্রণ সিস্টেমে সরাসরি প্রয়োগ করা যায়
  3. পুনরুৎপাদনযোগ্যতা: বিস্তারিত বাস্তবায়ন এবং ওপেন সোর্স কোড প্রদান করে

প্রযোজ্য পরিস্থিতি

  • অনিশ্চয়তা অনুমান প্রয়োজন এমন বহু-সেন্সর সংমিশ্রণ সিস্টেম
  • LiDAR অবনত পরিবেশে robust স্থানীয়করণ
  • pose অনুমান গুণমানের জন্য কঠোর প্রয়োজনীয়তা সহ প্রয়োগ পরিস্থিতি

সংদর্ভ

পেপারটি 68 টি সম্পর্কিত সংদর্ভ উদ্ধৃত করে, যা SLAM, সম্ভাব্য অনুমান, সেন্সর সংমিশ্রণ এবং অন্যান্য একাধিক ক্ষেত্রের গুরুত্বপূর্ণ কাজ অন্তর্ভুক্ত করে, এই গবেষণার জন্য একটি শক্তিশালী তাত্ত্বিক ভিত্তি প্রদান করে।

সামগ্রিক মূল্যায়ন: এটি রোবোটিক্স ক্ষেত্রে গুরুত্বপূর্ণ অবদান সহ একটি উচ্চ-মানের পেপার, যা উন্নত variational অনুমান কৌশলকে LiDAR odometry সমস্যায় সফলভাবে প্রয়োগ করে, তাত্ত্বিক উদ্ভাবন এবং ব্যবহারিকতার মধ্যে ভাল ভারসাম্য অর্জন করে।