REPOSITORY
jbnu/sensor-fusion-localization Private
[참조 MVP] 센서융합 측위 A-SW — GNSS와 주행 추정값을 품질 가중치로 융합해 연속적인 위치를 제공합니다.
https://git.agrithing.ai/jbnu/sensor-fusion-localization.git c15cf86 feat: adopt cpp VPU SDV reference implementation
b287380 ci: add language-specific static and dynamic analysis
67952cf docs: define component scope and interface contract
79dc9fc ci: verify contract tests and evidence package
dd56d7b feat: add executable reference MVP
7d05c47 docs: define component scope and interface contract
1 items · main
·/ src/component.cpp
text · 422 B · 808b64a Download
#include "component.hpp"#include <algorithm>#include <stdexcept>namespace asw {FusedPose fuse(double gx, double gy, double gq, double ox, double oy, double oq) { gq = std::max(0.0, gq); oq = std::max(0.0, oq); const double total = gq + oq; if (total == 0) throw std::invalid_argument("sensor confidence required"); return {(gx * gq + ox * oq) / total, (gy * gq + oy * oq) / total, std::min(1.0, total / 2)};}}