激光雷达和毫米波雷达数据融合基于无迹卡尔曼滤波算法c++项目源码.zip

R 8.46642 0.0287602 -3.04035 1477010443399637 8.6 0.25 -3.00029 0 L 8.44818 0.251553 1477010443449633 8.45 0.25 -3.00027 0 R 8.57101 0.0282318 -0.0105258 1477010443499690 8.45 0.25 0 0 L 8.45582 0.253997 1477010443549747 8.45 0.25 0 0 R 8.42927 0.0301427 -1.85813 1477010443604698 8.35 0.25 -1.81979 0 L 8.23962 0.24916 1477010443659650 8.25 0.25 -1.81978 0 R 7.9351 0.0237437 -3.81077 1477010443709653 8.05 0.2 -3.99976 -0.99994 L 7.84073 0.159858 1477010443759657 7.85 0.15 -3.99972 -0.99993 R 7.61428 0.0204653 -3.22052 1477010443809660 7.7 0.15 -2.99982 0 L 7.54016 0.159641 1477010443859663 7.55 0.15 -2.99982 0 R 7.50876 0.0127032 -1.89765 1477010443914714 7.45 0.100001 -1.8165 -0.908239 L 7.3426 0.0345312 1477010443969766 7.35 0.0500011 -1.81648 -0.90823 R 7.20598 0.000683772 -2.79536 1477010444024741 7.2 9.49949e-07 -2.72851 -0.909507 L 7.05406 -0.0533413 1477010444079717 7.05 -0.0499992 -2.72849 -0.909499 R 6.74737 -0.0212224 -1.67069 1477010444134693 6.95 -0.15 -1.81898 -1.81898 L 6.84972 -0.258748 1477010444189670 6.85 -0.25 -1.81896 -1.81897 R 6.67866 -0.0519302 -2.02379 1477010444239651 6.75 -0.349999 -2.00076 -2.00075 L 6.64329 -0.462604 1477010444289632 6.65 -0.449999 -2.00076 -2.00075 R 6.63205 -0.0840904 -0.81497 1477010444339690 6.6 -0.549999 -0.998836 -1.99769 L 6.56029 -0.650892 1477010444389748 6.55 -0.65 -0.99884 -1.99769 R 6.46217 -0.130812 -0.356062 1477010444444769 6.5 -0.85 -0.908747 -3.63498 L 6.45805 -1.05268 1477010444499791 6.45 -1.05 -0.908739 -3.63494 R 6.49021 -0.179219 -1.23944 1477010444554767 6.35 -1.15 -1.81897 -1.81898 L 6.25499 -1.25007 1477010444609744 6.25 -1.25 -1.81896 -1.81896 R 6.59968 -0.226407 1.73835 1477010444664705 6.3 -1.45 0.909739 -3.63894 L 6.36328 -1.65656 1477010444719667 6.35 -1.65 0.909727 -3.63891 R 6.57796 -0.279439 -0.211523 1477010444769692 6.3 -1.8 -0.999494 -2.9985 L 6.24641 -1.95075 1477010444819718 6.25 -1.95 -0.999489 -2.99847 R 6.66141 -0.322252 1.75689 1477010444869719 6.3 -2.1 0.999984 -2.99994 L 6.34644 -2.23829 1477010444919720 6.35 -2.25 0.999979 -2.99994 R 6.76596 -0.36264 0.855484 1477010444974743 6.35 -2.4 0 -2.72613 L 6.34927 -2.55175 1477010445029767 6.35 -2.55 0 -2.72611 R 6.98232 -0.399959 1.89805 1477010445084742 6.4 -2.7 0.909499 -2.72851 L 6.43257 -2.84245 1477010445139717 6.45 -2.85 0.909503 -2.72851 R 7.12938 -0.43502 1.4149 1477010445189758 6.45 -3 0 -2.99754 L 6.44119 -3.14955 1477010445239799 6.45 -3.15 0 -2.99754 R 7.31886 -0.470836 2.21289 1477010445294720 6.5 -3.3 0.910402 -2.7312 L 6.5453 -3.45745 1477010445349641 6.55 -3.45 0.910402 -2.7312 R 7.5456 -0.49614 2.70911 1477010445404670 6.65 -3.6 1.81722 -2.72583 L 6.76011 -3.75457 1477010445459700 6.75 -3.75 1.81721 -2.72581 R 7.884 -0.521437 2.20619 1477010445514767 6.8 -3.9 0.907988 -2.72396 L 6.85997 -4.05805 1477010445569835 6.85 -4.05 0.907976 -2.72393 R 8.04387 -0.547179 2.23987 1477010445624820 6.9 -4.2 0.909334 -2.72801 L 6.94332 -4.34473 1477010445679806 6.95 -4.35 0.90933 -2.72799 R 8.3635 -0.567708 1.67528 1477010445734748 7 -4.45 0.910054 -1.8201 L 7.04099 -4.55018 1477010445789690 7.05 -4.55 0.910054 -1.8201 R 8.50541 -0.582556 2.23409 1477010445844738 7.1 -4.7 0.908302 -2.72489 L 7.14735 -4.86125 1477010445899786 7.15 -4.85 0.908297 -2.72489 R 8.88902 -0.604494 3.05765 1477010445954759 7.25 -5 1.81907 -2.72861 L 7.30424 -5.15404 1477010446009732 7.35 -5.15 1.81907 -2.72861 R 8.97814 -0.622421 2.42827 1477010446064786 7.4 -5.3 0.908194 -2.7246 L 7.44737 -5.45308 1477010446119841 7.45 -5.45 0.90819 -2.72457 R 9.4762 -0.63468 2.54048 1477010446174794 7.55 -5.55 1.81974 -1.81974 L 7.64356 -5.66706 1477010446229748 7.65 -5.65 1.81972 -1.81972 R 9.53172 -0.647271 2.40306 1477010446284703 7.7 -5.8 0.90983 -2.72951 L 7.7342 -5.95374 1477010446339659 7.75 -5.95 0.909826 -2.72948 R 9.89957 -0.659824 3.5853 1477010446389694 7.85 -6.1 1.9986 -2.9979 L 7.95703 -6.24328 1477010446439730 7.95 -6.25 1.99858 -2.99787 R 10.4099 -0.66785 2.53218 1477010446494754 8.05 -6.35 1.81738 -1.81739 L 8.15891 -6.45335 1477010446549779 8.15 -6.45 1.81737 -1.81737 R 10.3865 -0.678464 2.50771 1477010446604767 8.2 -6.6 0.909293 -2.72787 L 8.25411 -6.74791 1477010446659755 8.25 -6.75 0.909293 -2.72787 R 10.6843 -0.687607 2.70793 1477010446714702 8.35 -6.85 1.81994 -1.81993 L 8.44494 -6.95805 1477010446769649 8.45 -6.95 1.81993 -1.81993 R 10.9406 -0.696337 2.56416 1477010446819646 8.5 -7.1 1.00006 -3.00018 L 8.54925 -7.24433 1477010446869643 8.55 -7.25 1.00006 -3.00018 R 11.3727 -0.707378 3.44956 1477010446919691 8.65 -7.4 1.99807 -2.99712 L 8.73559 -7.5421 1477010446969739 8.75 -7.55 1.99808 -2.99712 R 11.7598 -0.716035 2.04742 1477010447024687 8.8 -7.65 0.909955 -1.8199 L 8.84538 -7.75497 1477010447079636 8.85 -7.75 0.909946 -1.81988 R 11.8789 -0.726017 2.80161 1477010447129681 8.9 -7.9 0.999086 -2.9973 L 8.95966 -8.0381 1477010447179726 8.95 -8.05 0.999095 -2.9973 R 11.9442 -0.735521 1.86678 1477010447234713 9 -8.15 0.909309 -1.8186 L 9.05896 -8.24314 1477010447289701 9.05 -8.25 0.909301 -1.81859 R 12.4893 -0.745345 2.79706 1477010447339681 9.1 -8.4 1.0004 -3.00119 L 9.15332 -8.54857 1477010447389662 9.15 -8.55 1.00038 -3.00117 R 12.6764 -0.755304 1.92258 1477010447444637 9.2 -8.65 0.909508 -1.819 L 9.24541 -8.76863 1477010447499613 9.25 -8.75 0.9095 -1.81899 R 13.0018 -0.765199 4.2891 1477010447549622 9.35 -8.95 1.99965 -3.99928 L 9.44703 -9.15328 1477010447599631 9.45 -9.15 1.99964 -3.99928 R 13.2646 -0.772362 2.209 1477010447649652 9.5 -9.25 0.999584 -1.99917 L 9.54157 -9.35195 1477010447699673 9.55 -9.35 0.999584 -1.99917 R 13.3655 -0.782802 2.24797 1477010447749669 9.55 -9.5 0 -3.00023 L 9.54779 -9.64959 1477010447799666 9.55 -9.65 0 -3.0002 R 13.8483 -0.794831 2.85181 1477010447849716 9.6 -9.8 0.999005 -2.997 L 9.64606 -9.9341 1477010447899766 9.65 -9.95 0.998995 -2.997 R 13.8368 -0.803954 1.95724 1477010447954720 9.7 -10.05 0.909855 -1.81969 L 9.73801 -10.1396 1477010448009675 9.75 -10.15 0.909847 -1.81969 R 14.4307 -0.812263 2.35389 1477010448059664 9.75 -10.3 0 -3.00065 L 9.75524 -10.4732 1477010448109654 9.75 -10.45 0 -3.00063 R 14.3135 -0.824455 2.63112 1477010448164710 9.8 -10.6 0.90817 -2.72451 L 9.85048 -10.7526 1477010448219767 9.85 -10.75 0.908161 -2.72448 R 14.7429 -0.835956 1.92166 1477010448274697 9.85 -10.9 0 -2.73074 L 9.83614 -11.041 1477010448329628 9.85 -11.05 0 -2.73073 R 14.8851 -0.848604 2.27417 1477010448379634 9.85 -11.2 0 -2.99965 L 9.84568 -11.3496 1477010448429641 9.85 -11.35 0 -2.99961 R 15.2094 -0.863774 2.26264 1477010448479667 9.85 -11.5 0 -2.99843 L 9.83206 -11.6307 1477010448529693 9.85 -11.65 0 -2.99843 R 15.413 -0.877244 0.866545 1477010448579678 9.8 -11.75 -1.0003 -2.00061 L 9.74928 -11.8442 1477010448629664 9.75 -11.85 -1.00029 -2.00059 R 15.4054 -0.88995 1.77828 1477010448679644 9.7 -12 -1.0004 -3.00119 L 9.65354 -12.1497 1477010448729625 9.65 -12.15 -1.00039 -3.00116 R 15.7547 -0.905673 1.01994 1477010448779630 9.6 -12.25 -0.999885 -1.99981 L 9.54859 -12.3478 1477010448829636 9.55 -12.35 -0.999884 -1.99979 R 15.5466 -0.922266 0.369379 1477010448879685 9.45 -12.45 -1.99803 -1.99805 L 9.36086 -12.5501 1477010448929734 9.35 -12.55 -1.99804 -1.99804 R 15.7759 -0.936847 0.912459 1477010448984693 9.3 -12.65 -0.909773 -1.81953 L 9.22134 -12.7613 1477010449039652 9.25 -12.75 -0.909773 -1.81954 R 15.9017 -0.95744 -0.700602 1477010449089745 9.05 -12.85 -3.99257 -1.99629 L 8.84161 -12.9519 1477010449139839 8.85 -12.95 -3.99253 -1.99627 R 15.6195 -0.978773 -0.291637 1477010449194745 8.75 -13 -1.8213 -0.910651 L 8.66358 -13.0431 1477010449249651 8.65 -13.05 -1.8213 -0.910651 R 15.6995 -0.995246 -0.795374 1477010449299701 8.5 -13.1 -2.997 -0.999005 L 8.35763 -13.1557 1477010449349751 8.35 -13.15 -2.997 -0.998995 R 15.5295 -1.0123 -1.48799 1477010449404748 8.2 -13.15 -2.72741 0 L 8.03583 -13.1513 1477010449459745 8.05 -13.15 -2.72742 0 R 15.2205 -1.03051 -1.3479 1477010449514693 7.9 -13.15 -2.7