C++_无迹卡尔曼滤波（UKF）

L 3.122427e-01 5.803398e-01 1477010443000000 6.000000e-01 6.000000e-01 5.199937e+00 0 0 6.911322e-03 R 1.014892e+00 5.543292e-01 4.892807e+00 1477010443050000 8.599968e-01 6.000449e-01 5.199747e+00 1.796856e-03 3.455661e-04 1.382155e-02 L 1.173848e+00 4.810729e-01 1477010443100000 1.119984e+00 6.002246e-01 5.199429e+00 5.389957e-03 1.036644e-03 2.072960e-02 R 1.047505e+00 3.892401e-01 4.511325e+00 1477010443150000 1.379955e+00 6.006288e-01 5.198979e+00 1.077814e-02 2.073124e-03 2.763437e-02 L 1.650626e+00 6.246904e-01 1477010443200000 1.639904e+00 6.013473e-01 5.198392e+00 1.795970e-02 3.454842e-03 3.453479e-02 R 1.698300e+00 2.982801e-01 5.209986e+00 1477010443250000 1.899823e+00 6.024697e-01 5.197661e+00 2.693234e-02 5.181582e-03 4.142974e-02 L 2.188824e+00 6.487392e-01 1477010443300000 2.159704e+00 6.040855e-01 5.196776e+00 3.769324e-02 7.253069e-03 4.831816e-02 R 2.044382e+00 2.760018e-01 5.043867e+00 1477010443350000 2.419540e+00 6.062840e-01 5.195728e+00 5.023894e-02 9.668977e-03 5.519894e-02 L 2.655256e+00 6.659798e-01 1477010443400000 2.679323e+00 6.091545e-01 5.194504e+00 6.456542e-02 1.242892e-02 6.207101e-02 R 2.990916e+00 2.176679e-01 5.191807e+00 1477010443450000 2.939043e+00 6.127858e-01 5.193090e+00 8.066803e-02 1.553247e-02 6.893328e-02 L 3.012223e+00 6.370455e-01 1477010443500000 3.198690e+00 6.172666e-01 5.191470e+00 9.854147e-02 1.897914e-02 7.578466e-02 R 3.593878e+00 1.354522e-01 5.161753e+00 1477010443550000 3.458253e+00 6.226855e-01 5.189627e+00 1.181798e-01 2.276837e-02 8.262407e-02 L 3.893650e+00 3.117930e-01 1477010443600000 3.717722e+00 6.291305e-01 5.187542e+00 1.395764e-01 2.689958e-02 8.945044e-02 R 4.255547e+00 1.648397e-01 5.433327e+00 1477010443650000 3.977082e+00 6.366893e-01 5.185194e+00 1.627238e-01 3.137210e-02 9.626268e-02 L 4.309346e+00 5.785637e-01 1477010443700000 4.236322e+00 6.454494e-01 5.182560e+00 1.876140e-01 3.618523e-02 1.030597e-01 R 4.670263e+00 1.481801e-01 5.120847e+00 1477010443750000 4.495424e+00 6.554977e-01 5.179618e+00 2.142382e-01 4.133822e-02 1.098405e-01 L 4.351431e+00 8.991741e-01 1477010443800000 4.754374e+00 6.669207e-01 5.176340e+00 2.425866e-01 4.683024e-02 1.166039e-01 R 5.251417e+00 1.271635e-01 4.825914e+00 1477010443850000 5.013155e+00 6.798044e-01 5.172700e+00 2.726487e-01 5.266044e-02 1.233489e-01 L 5.518935e+00 6.482327e-01 1477010443900000 5.271746e+00 6.942343e-01 5.168671e+00 3.044132e-01 5.882788e-02 1.300744e-01 R 5.267293e+00 1.216834e-01 5.423506e+00 1477010443950000 5.530128e+00 7.102953e-01 5.164221e+00 3.378677e-01 6.533161e-02 1.367794e-01 L 6.022003e+00 7.086193e-01 1477010444000000 5.788279e+00 7.280715e-01 5.159319e+00 3.729989e-01 7.217058e-02 1.434628e-01 R 5.905749e+00 6.329996e-02 4.879680e+00 1477010444050000 6.046176e+00 7.476465e-01 5.153933e+00 4.097925e-01 7.934372e-02 1.501236e-01 L 6.342486e+00 9.488326e-01 1477010444100000 6.303794e+00 7.691030e-01 5.148029e+00 4.482333e-01 8.684990e-02 1.567606e-01 R 6.673922e+00 1.256145e-01 5.006870e+00 1477010444150000 6.561105e+00 7.925232e-01 5.141571e+00 4.883049e-01 9.468793e-02 1.633729e-01 L 6.782143e+00 7.140359e-01 1477010444200000 6.818081e+00 8.179882e-01 5.134523e+00 5.299897e-01 1.028566e-01 1.699593e-01 R 7.318441e+00 8.629228e-02 4.649107e+00 1477010444250000 7.074691e+00 8.455782e-01 5.126847e+00 5.732691e-01 1.113545e-01 1.765190e-01 L 7.137350e+00 9.572165e-01 1477010444300000 7.330903e+00 8.753725e-01 5.118505e+00 6.181232e-01 1.201805e-01 1.830507e-01 R 8.124935e+00 1.010471e-01 5.464240e+00 1477010444350000 7.586684e+00 9.074494e-01 5.109456e+00 6.645307e-01 1.293330e-01 1.895536e-01 L 7.805334e+00 7.191261e-01 1477010444400000 7.841995e+00 9.418861e-01 5.099659e+00 7.124693e-01 1.388107e-01 1.960265e-01 R 8.450951e+00 1.048616e-01 4.750535e+00 1477010444450000 8.096800e+00 9.787585e-01 5.089074e+00 7.619151e-01 1.486120e-01 2.024685e-01 L 8.247959e+00 8.403219e-01 1477010444500000 8.351056e+00 1.018142e+00 5.077658e+00 8.128429e-01 1.587355e-01 2.088785e-01 R 8.575491e+00 1.653115e-01 5.580596e+00 1477010444550000 8.604722e+00 1.060109e+00 5.065366e+00 8.652261e-01 1.691794e-01 2.152555e-01 L 8.746145e+00 1.048576e+00 1477010444600000 8.857753e+00 1.104732e+00 5.052156e+00 9.190366e-01 1.799422e-01 2.215985e-01 R 9.946663e+00 1.150557e-01 5.240801e+00 1477010444650000 9.110101e+00 1.152082e+00 5.037982e+00 9.742446e-01 1.910221e-01 2.279066e-01 L 9.255788e+00 1.049129e+00 1477010444700000 9.361717e+00 1.202229e+00 5.022799e+00 1.030819e+00 2.024174e-01 2.341786e-01 R 1.021600e+01 1.498099e-01 5.311647e+00 1477010444750000 9.612549e+00 1.255239e+00 5.006562e+00 1.088727e+00 2.141263e-01 2.404137e-01 L 1.004839e+01 1.445978e+00 1477010444800000 9.862544e+00 1.311179e+00 4.989224e+00 1.147935e+00 2.261470e-01 2.466108e-01 R 1.067808e+01 1.623090e-01 4.806610e+00 1477010444850000 1.011165e+01 1.370112e+00 4.970739e+00 1.208405e+00 2.384776e-01 2.527689e-01 L 1.024922e+01 1.459068e+00 1477010444900000 1.035979e+01 1.432101e+00 4.951060e+00 1.270101e+00 2.511160e-01 2.588872e-01 R 1.104064e+01 1.549056e-01 4.564011e+00 1477010444950000 1.060693e+01 1.497206e+00 4.930142e+00 1.332982e+00 2.640604e-01 2.649645e-01 L 1.073126e+01 1.452653e+00 1477010445000000 1.085299e+01 1.565486e+00 4.907936e+00 1.397008e+00 2.773086e-01 2.710000e-01 R 1.156684e+01 1.238384e-01 5.142052e+00 1477010445050000 1.109790e+01 1.636997e+00 4.884396e+00 1.462135e+00 2.908586e-01 2.769928e-01 L 1.158696e+01 1.614624e+00 1477010445100000 1.134161e+01 1.711793e+00 4.859477e+00 1.528318e+00 3.047082e-01 2.829417e-01 R 1.157909e+01 1.333215e-01 4.869483e+00 1477010445150000 1.158403e+01 1.789925e+00 4.833131e+00 1.595511e+00 3.188553e-01 2.888460e-01 L 1.177877e+01 1.745907e+00 1477010445200000 1.182511e+01 1.871443e+00 4.805313e+00 1.663664e+00 3.332976e-01 2.947047e-01 R 1.232484e+01 1.752895e-01 5.277554e+00 1477010445250000 1.206475e+01 1.956393e+00 4.775977e+00 1.732729e+00 3.480329e-01 3.005169e-01 L 1.232259e+01 1.783533e+00 1477010445300000 1.230289e+01 2.044820e+00 4.745079e+00 1.802651e+00 3.630587e-01 3.062816e-01 R 1.267093e+01 1.407283e-01 5.316736e+00 1477010445350000 1.253944e+01 2.136766e+00 4.712575e+00 1.873377e+00 3.783728e-01 3.119979e-01 L 1.259241e+01 2.175092e+00 1477010445400000 1.277433e+01 2.232269e+00 4.678422e+00 1.944850e+00 3.939727e-01 3.176650e-01 R 1.348558e+01 1.988829e-01 5.446424e+00 1477010445450000 1.300747e+01 2.331365e+00 4.642576e+00 2.017013e+00 4.098559e-01 3.232819e-01 L 1.308745e+01 2.407081e+00 1477010445500000 1.323878e+01 2.434087e+00 4.604997e+00 2.089806e+00 4.260200e-01 3.288477e-01 R 1.308715e+01 2.410651e-01 4.512749e+00 1477010445550000 1.346816e+01 2.540465e+00 4.565645e+00 2.163167e+00 4.424624e-01 3.343617e-01 L 1.383597e+01 2.624793e+00 1477010445600000 1.369552e+01 2.650527e+00 4.524480e+00 2.237032e+00 4.591805e-01 3.398228e-01 R 1.409883e+01 1.955096e-01 4.806121e+00 1477010445650000 1.392079e+01 2.764295e+00 4.481466e+00 2.311336e+00 4.761716e-01 3.452302e-01 L 1.421055e+01 2.942051e+00 1477010445700000 1.414385e+01 2.881790e+00 4.436565e+00 2.386012e+00 4.934331e-01 3.505832e-01 R 1.483710e+01 1.946756e-01 5.233370e+00 1477010445750000 1.436462e+01 3.003029e+00 4.389744e+00 2.460991e+00 5.109623e-01 3.558808e-01 L 1.446161e+01 2.907340e+00 1477010445800000 1.458300e+01 3.128024e+00 4.340970e+00 2.536202e+00 5.287563e-01 3.611222e-01 R 1.520044e+01 2.635874e-01 5.157074e+00 1477010445850000 1.479890e+01 3.256787e+00 4.290211e+00 2.611572e+00 5.468125e-01 3.663065e-01 L 1.502608e+01 3.506701e+00 1477010445900000 1.501220e+01 3.389323e+00 4.237439e+00 2.687028e+00 5.651278e-01 3.714330e-01 R 1.591832e+01 2.635980e-01 4.665886e+00 1477010445950000 1.522281e+01 3.525634e+00 4.182627e+00 2.762494e+00 5.836994e-01 3.765009e-01 L 1.552355e+01 3.829364e+00 1477010446000000 1.543063e+01 3.665719e+00 4.125748e+00 2.837893e+00 6.025245e-01 3.815093e-01 R 1.608904e+01 2.135971e-01 4.785617e+00 1477010446050000 1.563555e+01 3.809572e+00 4.066782e+00 2.913146e+00 6.215999e-01 3.86457