[GPS=00000.000s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.000,76.92,1500,1500,idle,0,0.000,0.000,0.000,0.00,0.00,0.000,0.000*37 [GPS=02887.200s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,2887200,3.000,0.053,-0.000,90.00,274.98,1.770,0.160*00 [GPS=02887.200s r=1] STM32 UART5 POSE: $POSE,3.000,0.053,-0.000,90.00,0.00,-0.00,1.770,0.160,2887200*18 [GPS=28872.005s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872005,3.000,0.053,-0.000,90.00,274.98,1.770,0.160*35 [GPS=28872.029s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872029,3.000,0.053,-0.000,90.03,274.98,1.770,0.160*38 [GPS=28872.041s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872041,3.000,0.053,-0.000,90.09,274.98,1.770,0.160*3C [GPS=28872.053s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872053,3.000,0.053,-0.000,90.17,274.98,1.770,0.160*30 [GPS=28872.065s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872065,3.000,0.053,-0.000,90.28,274.98,1.770,0.160*39 [GPS=28872.071s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872071,3.000,0.053,-0.000,90.41,274.98,1.770,0.160*33 [GPS=28872.083s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872083,3.000,0.053,-0.000,90.57,274.98,1.770,0.160*39 [GPS=28872.107s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872107,3.000,0.053,-0.000,89.63,274.98,1.770,0.160*3B [GPS=28872.119s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872119,3.000,0.053,-0.000,89.87,274.98,1.770,0.160*3E [GPS=28872.131s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872131,3.000,0.053,-0.000,90.15,274.98,1.770,0.160*37 [GPS=28872.137s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872137,3.000,0.053,-0.000,90.44,274.98,1.770,0.160*35 [GPS=28872.149s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872149,3.000,0.053,-0.000,90.75,274.98,1.770,0.160*3E [GPS=28872.173s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872173,3.000,0.053,-0.000,91.12,274.98,1.770,0.160*37 [GPS=28872.185s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872185,3.000,0.053,-0.000,91.52,274.98,1.770,0.160*3A [GPS=28872.197s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872197,3.000,0.053,-0.000,91.96,274.98,1.770,0.160*31 [GPS=28872.203s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872203,3.000,0.053,-0.000,87.43,274.98,1.770,0.160*30 [GPS=28872.215s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872215,3.000,0.053,-0.000,87.91,274.98,1.770,0.160*38 [GPS=28872.239s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872239,3.000,0.053,-0.000,88.44,274.98,1.770,0.160*31 [GPS=28872.251s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872251,3.000,0.053,-0.000,89.01,274.98,1.770,0.160*3F [GPS=28872.263s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872263,3.000,0.053,-0.000,89.60,274.98,1.770,0.160*39 [GPS=28872.275s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872275,3.000,0.053,-0.000,90.21,274.98,1.770,0.160*33 [GPS=28872.281s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872281,3.000,0.053,-0.000,90.82,274.98,1.770,0.160*31 [GPS=28872.293s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872293,3.000,0.053,-0.000,91.43,274.98,1.770,0.160*3E [GPS=28872.317s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872317,3.000,0.053,-0.000,83.39,274.98,1.770,0.160*3D [GPS=28872.329s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872329,3.000,0.053,-0.000,84.00,274.98,1.770,0.160*3D [GPS=28872.341s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872341,3.000,0.053,-0.000,84.61,274.98,1.770,0.160*34 [GPS=28872.347s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872347,3.000,0.053,-0.000,85.22,274.98,1.770,0.160*34 [GPS=28872.359s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872359,3.000,0.053,-0.000,85.83,274.98,1.770,0.160*30 [GPS=28872.371s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872371,3.000,0.053,-0.000,86.44,274.98,1.770,0.160*32 [GPS=28872.395s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872395,3.000,0.053,-0.000,87.06,274.98,1.770,0.160*3F [GPS=28872.395s r=1] STM32 UART5 STATE: $STATE,goto_start,1.235,172.08,28872395*4A [GPS=28872.395s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872395,3.000,0.053,-0.000,87.67,274.98,1.770,0.160*38 [GPS=28872.413s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872413,3.000,0.053,-0.000,78.71,274.98,1.770,0.160*36 [GPS=28872.425s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872425,3.000,0.053,-0.000,79.32,274.98,1.770,0.160*35 [GPS=28872.437s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872437,3.000,0.053,-0.000,79.93,274.98,1.770,0.160*3D [GPS=28872.461s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872461,3.000,0.053,-0.000,80.54,274.98,1.770,0.160*33 [GPS=28872.473s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872473,3.000,0.053,-0.000,81.15,274.98,1.770,0.160*34 [GPS=28872.479s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872479,3.000,0.053,-0.000,81.76,274.98,1.770,0.160*3B [GPS=28872.491s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872491,3.000,0.053,-0.000,82.37,274.98,1.770,0.160*3B [GPS=28872.491s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872491,3.000,0.053,-0.000,74.04,274.98,1.770,0.160*32 [GPS=28872.515s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872515,3.000,0.053,-0.000,74.65,274.98,1.770,0.160*38 [GPS=28872.539s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872539,3.000,0.053,-0.000,75.27,274.98,1.770,0.160*31 [GPS=28872.545s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872545,3.000,0.053,-0.000,75.88,274.98,1.770,0.160*3F [GPS=28872.557s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872557,3.000,0.053,-0.000,76.49,274.98,1.770,0.160*32 [GPS=28872.569s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872569,3.000,0.053,-0.000,77.10,274.98,1.770,0.160*32 [GPS=28872.581s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872581,3.000,0.053,-0.000,77.71,274.98,1.770,0.160*33 [GPS=28872.593s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872593,3.000,0.053,-0.000,78.32,274.98,1.770,0.160*38 [GPS=28872.605s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872605,3.000,0.053,-0.000,69.37,274.98,1.770,0.160*31 [GPS=28872.623s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872623,3.000,0.053,-0.000,69.98,274.98,1.770,0.160*30 [GPS=28872.635s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872635,3.000,0.053,-0.000,70.59,274.98,1.770,0.160*32 [GPS=28872.647s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872647,3.000,0.053,-0.000,71.20,274.98,1.770,0.160*38 [GPS=28872.659s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872659,3.000,0.053,-0.000,71.81,274.98,1.770,0.160*3C [GPS=28872.677s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872677,3.000,0.053,-0.000,72.42,274.98,1.770,0.160*3C [GPS=28872.689s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872689,3.000,0.053,-0.000,73.03,274.98,1.770,0.160*39 [GPS=28872.701s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872701,3.000,0.053,-0.000,73.64,274.98,1.770,0.160*39 [GPS=28872.713s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872713,3.000,0.053,-0.000,64.99,274.98,1.770,0.160*3E [GPS=28872.725s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872725,3.000,0.053,-0.000,65.61,274.98,1.770,0.160*3D [GPS=28872.731s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872731,3.000,0.053,-0.000,66.22,274.98,1.770,0.160*3C [GPS=28872.755s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872755,3.000,0.053,-0.000,66.83,274.98,1.770,0.160*35 [GPS=28872.767s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872767,3.000,0.053,-0.000,67.44,274.98,1.770,0.160*3E [GPS=28872.779s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872779,3.000,0.053,-0.000,68.05,274.98,1.770,0.160*3B [GPS=28872.791s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872791,3.000,0.053,-0.000,68.66,274.98,1.770,0.160*38 [GPS=28872.797s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872797,3.000,0.053,-0.000,69.27,274.98,1.770,0.160*3A [GPS=28872.809s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872809,3.000,0.053,-0.000,60.32,274.98,1.770,0.160*3F [GPS=28872.833s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872833,3.000,0.053,-0.000,60.93,274.98,1.770,0.160*3D [GPS=28872.845s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872845,3.000,0.053,-0.000,61.54,274.98,1.770,0.160*36 [GPS=28872.857s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872857,3.000,0.053,-0.000,62.15,274.98,1.770,0.160*33 [GPS=28872.863s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872863,3.000,0.053,-0.000,62.76,274.98,1.770,0.160*31 [GPS=28872.875s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872875,3.000,0.053,-0.000,63.37,274.98,1.770,0.160*32 [GPS=28872.899s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872899,3.000,0.053,-0.000,63.98,274.98,1.770,0.160*35 [GPS=28872.899s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872899,3.000,0.053,-0.000,64.59,274.98,1.770,0.160*3F [GPS=28872.923s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872923,3.000,0.053,-0.000,55.65,274.98,1.770,0.160*32 [GPS=28872.929s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872929,3.000,0.053,-0.000,56.26,274.98,1.770,0.160*3C [GPS=28872.940s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872940,3.000,0.053,-0.000,56.87,274.98,1.770,0.160*38 [GPS=28872.953s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872953,3.000,0.053,-0.000,57.48,274.98,1.770,0.160*38 [GPS=28872.976s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872976,3.000,0.053,-0.000,58.09,274.98,1.770,0.160*35 [GPS=28872.989s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28872989,3.000,0.053,-0.000,58.70,274.98,1.770,0.160*3B [GPS=28873.000s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873000,3.000,0.053,-0.000,59.32,274.98,1.770,0.160*35 [GPS=28873.000s r=1] STM32 UART5 POSE: $POSE,3.000,0.053,-0.000,59.32,0.00,-0.00,1.770,0.160,28873000*2D [GPS=28873.000s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873000,3.000,0.053,-0.000,50.99,274.98,1.770,0.160*3D [GPS=28873.018s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873018,3.000,0.053,-0.000,51.61,274.98,1.770,0.160*32 [GPS=28873.042s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873042,3.000,0.053,-0.000,52.22,274.98,1.770,0.160*39 [GPS=28873.054s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873054,3.000,0.053,-0.000,52.83,274.98,1.770,0.160*35 [GPS=28873.060s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873060,3.000,0.053,-0.000,53.44,274.98,1.770,0.160*38 [GPS=28873.072s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873072,3.000,0.053,-0.000,54.05,274.98,1.770,0.160*39 [GPS=28873.084s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873084,3.000,0.053,-0.000,54.67,274.98,1.770,0.160*34 [GPS=28873.096s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873096,3.000,0.053,-0.000,55.28,274.98,1.770,0.160*3D [GPS=28873.119s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873119,3.000,0.053,-0.000,46.36,274.98,1.770,0.160*36 [GPS=28873.125s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873125,3.000,0.053,-0.000,46.97,274.98,1.770,0.160*32 [GPS=28873.137s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873137,3.000,0.053,-0.000,47.58,274.98,1.770,0.160*33 [GPS=28873.149s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873149,3.000,0.053,-0.000,48.19,274.98,1.770,0.160*30 [GPS=28873.161s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873161,3.000,0.053,-0.000,48.80,274.98,1.770,0.160*3A [GPS=28873.185s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873185,3.000,0.053,-0.000,49.41,274.98,1.770,0.160*3C [GPS=28873.197s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873197,3.000,0.053,-0.000,50.02,274.98,1.770,0.160*30 [GPS=28873.202s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873202,3.000,0.053,-0.000,50.63,274.98,1.770,0.160*38 [GPS=28873.214s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873214,3.000,0.053,-0.000,41.71,274.98,1.770,0.160*3C [GPS=28873.226s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873226,3.000,0.053,-0.000,42.32,274.98,1.770,0.160*39 [GPS=28873.250s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873250,3.000,0.053,-0.000,42.94,274.98,1.770,0.160*34 [GPS=28873.262s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873262,3.000,0.053,-0.000,43.55,274.98,1.770,0.160*39 [GPS=28873.268s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873268,3.000,0.053,-0.000,44.16,274.98,1.770,0.160*33 [GPS=28873.280s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873280,3.000,0.053,-0.000,44.77,274.98,1.770,0.160*32 [GPS=28873.292s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873292,3.000,0.053,-0.000,45.38,274.98,1.770,0.160*3B [GPS=28873.304s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873304,3.000,0.053,-0.000,37.05,274.98,1.770,0.160*3E [GPS=28873.328s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873328,3.000,0.053,-0.000,37.66,274.98,1.770,0.160*35 [GPS=28873.340s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873340,3.000,0.053,-0.000,38.27,274.98,1.770,0.160*31 [GPS=28873.346s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873346,3.000,0.053,-0.000,38.88,274.98,1.770,0.160*32 [GPS=28873.358s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873358,3.000,0.053,-0.000,39.49,274.98,1.770,0.160*31 [GPS=28873.370s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873370,3.000,0.053,-0.000,40.10,274.98,1.770,0.160*39 [GPS=28873.394s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873394,3.000,0.053,-0.000,40.71,274.98,1.770,0.160*34 [GPS=28873.394s r=1] STM32 UART5 STATE: $STATE,goto_start,1.235,125.74,28873394*43 [GPS=28873.406s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873406,3.000,0.053,-0.000,41.32,274.98,1.770,0.160*3E [GPS=28873.412s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873412,3.000,0.053,-0.000,32.67,274.98,1.770,0.160*3F [GPS=28873.424s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873424,3.000,0.053,-0.000,33.28,274.98,1.770,0.160*30 [GPS=28873.436s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873436,3.000,0.053,-0.000,33.89,274.98,1.770,0.160*38 [GPS=28873.448s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873448,3.000,0.053,-0.000,34.50,274.98,1.770,0.160*32 [GPS=28873.472s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873472,3.000,0.053,-0.000,35.11,274.98,1.770,0.160*3F [GPS=28873.478s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873478,3.000,0.053,-0.000,35.72,274.98,1.770,0.160*30 [GPS=28873.490s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873490,3.000,0.053,-0.000,36.33,274.98,1.770,0.160*30 [GPS=28873.502s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873502,3.000,0.053,-0.000,36.94,274.98,1.770,0.160*37 [GPS=28873.514s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873514,3.000,0.053,-0.000,27.98,274.98,1.770,0.160*3C [GPS=28873.526s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873526,3.000,0.053,-0.000,28.59,274.98,1.770,0.160*3F [GPS=28873.544s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873544,3.000,0.053,-0.000,29.21,274.98,1.770,0.160*35 [GPS=28873.556s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873556,3.000,0.053,-0.000,29.82,274.98,1.770,0.160*3F [GPS=28873.568s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873568,3.000,0.053,-0.000,30.43,274.98,1.770,0.160*37 [GPS=28873.580s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873580,3.000,0.053,-0.000,31.04,274.98,1.770,0.160*33 [GPS=28873.592s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873592,3.000,0.053,-0.000,31.66,274.98,1.770,0.160*34 [GPS=28873.604s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873604,3.000,0.053,-0.000,32.27,274.98,1.770,0.160*3E [GPS=28873.622s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873622,3.000,0.053,-0.000,23.31,274.98,1.770,0.160*3D [GPS=28873.634s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873634,3.000,0.053,-0.000,23.92,274.98,1.770,0.160*33 [GPS=28873.646s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873646,3.000,0.053,-0.000,24.53,274.98,1.770,0.160*3C [GPS=28873.658s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873658,3.000,0.053,-0.000,25.14,274.98,1.770,0.160*31 [GPS=28873.670s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873670,3.000,0.053,-0.000,25.75,274.98,1.770,0.160*3C [GPS=28873.688s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873688,3.000,0.053,-0.000,26.36,274.98,1.770,0.160*3F [GPS=28873.700s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873700,3.000,0.053,-0.000,26.98,274.98,1.770,0.160*3A [GPS=28873.712s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873712,3.000,0.053,-0.000,27.59,274.98,1.770,0.160*35 [GPS=28873.724s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873724,3.000,0.053,-0.000,18.66,274.98,1.770,0.160*30 [GPS=28873.736s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873736,3.000,0.053,-0.000,19.27,274.98,1.770,0.160*37 [GPS=28873.742s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873742,3.000,0.053,-0.000,19.88,274.98,1.770,0.160*31 [GPS=28873.766s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873766,3.000,0.053,-0.000,20.49,274.98,1.770,0.160*30 [GPS=28873.778s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873778,3.000,0.053,-0.000,21.10,274.98,1.770,0.160*32 [GPS=28873.790s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873790,3.000,0.053,-0.000,21.70,274.98,1.770,0.160*32 [GPS=28873.802s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873802,3.000,0.053,-0.000,22.32,274.98,1.770,0.160*33 [GPS=28873.808s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873808,3.000,0.053,-0.000,13.98,274.98,1.770,0.160*3B [GPS=28873.832s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873832,3.000,0.053,-0.000,14.59,274.98,1.770,0.160*38 [GPS=28873.844s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873844,3.000,0.053,-0.000,15.20,274.98,1.770,0.160*36 [GPS=28873.856s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873856,3.000,0.053,-0.000,15.81,274.98,1.770,0.160*3E [GPS=28873.868s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873868,3.000,0.053,-0.000,16.43,274.98,1.770,0.160*3E [GPS=28873.874s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873874,3.000,0.053,-0.000,17.04,274.98,1.770,0.160*31 [GPS=28873.886s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873886,3.000,0.053,-0.000,17.65,274.98,1.770,0.160*3B [GPS=28873.910s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873910,3.000,0.053,-0.000,18.26,274.98,1.770,0.160*3D [GPS=28873.922s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873922,3.000,0.053,-0.000,9.30,274.98,1.770,0.160*0B [GPS=28873.928s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873928,3.000,0.053,-0.000,9.91,274.98,1.770,0.160*0A [GPS=28873.940s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873940,3.000,0.053,-0.000,10.53,274.98,1.770,0.160*32 [GPS=28873.952s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873952,3.000,0.053,-0.000,11.14,274.98,1.770,0.160*33 [GPS=28873.964s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873964,3.000,0.053,-0.000,11.75,274.98,1.770,0.160*31 [GPS=28873.988s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873988,3.000,0.053,-0.000,12.36,274.98,1.770,0.160*37 [GPS=28873.994s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28873994,3.000,0.053,-0.000,12.97,274.98,1.770,0.160*31 [GPS=28873.994s r=1] STM32 UART5 POSE: $POSE,3.000,0.053,-0.000,12.97,0.00,-0.00,1.770,0.160,28873994*29 [GPS=28874.006s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874006,3.000,0.053,-0.000,13.58,274.98,1.770,0.160*36 [GPS=28874.017s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874017,3.000,0.053,-0.000,4.90,274.98,1.770,0.160*04 [GPS=28874.028s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874028,3.000,0.053,-0.000,5.51,274.98,1.770,0.160*04 [GPS=28874.052s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874052,3.000,0.053,-0.000,6.13,274.98,1.770,0.160*0C [GPS=28874.064s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874064,3.000,0.053,-0.000,6.74,274.98,1.770,0.160*08 [GPS=28874.076s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874076,3.000,0.053,-0.000,7.35,274.98,1.770,0.160*0F [GPS=28874.082s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874082,3.000,0.053,-0.000,7.96,274.98,1.770,0.160*0D [GPS=28874.094s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874094,3.000,0.053,-0.000,8.57,274.98,1.770,0.160*08 [GPS=28874.106s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874106,3.000,0.053,-0.000,9.18,274.98,1.770,0.160*08 [GPS=28874.130s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874130,3.000,0.053,-0.000,0.28,274.98,1.770,0.160*07 [GPS=28874.136s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874136,3.000,0.053,-0.000,0.89,274.98,1.770,0.160*0A [GPS=28874.148s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874148,3.000,0.053,-0.000,1.50,274.98,1.770,0.160*06 [GPS=28874.160s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874160,3.000,0.053,-0.000,2.11,274.98,1.770,0.160*0A [GPS=28874.172s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874172,3.000,0.053,-0.000,2.72,274.98,1.770,0.160*0C [GPS=28874.196s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874196,3.000,0.053,-0.000,3.33,274.98,1.770,0.160*02 [GPS=28874.202s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874202,3.000,0.053,-0.000,3.94,274.98,1.770,0.160*01 [GPS=28874.202s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874202,3.000,0.053,-0.000,4.56,274.98,1.770,0.160*08 [GPS=28874.226s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874226,3.000,0.053,-0.000,355.60,274.98,1.770,0.160*0C [GPS=28874.238s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874238,3.000,0.053,-0.000,356.21,274.98,1.770,0.160*05 [GPS=28874.250s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874250,3.000,0.053,-0.000,356.82,274.98,1.770,0.160*02 [GPS=28874.274s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874274,3.000,0.053,-0.000,357.43,274.98,1.770,0.160*08 [GPS=28874.280s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874280,3.000,0.053,-0.000,358.05,274.98,1.770,0.160*0E [GPS=28874.292s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874292,3.000,0.053,-0.000,358.66,274.98,1.770,0.160*08 [GPS=28874.304s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874304,3.000,0.053,-0.000,359.27,274.98,1.770,0.160*02 [GPS=28874.316s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874316,3.000,0.053,-0.000,350.95,274.98,1.770,0.160*01 [GPS=28874.340s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874340,3.000,0.053,-0.000,351.56,274.98,1.770,0.160*0C [GPS=28874.346s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874346,3.000,0.053,-0.000,352.17,274.98,1.770,0.160*0C [GPS=28874.358s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874358,3.000,0.053,-0.000,352.78,274.98,1.770,0.160*0A [GPS=28874.370s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874370,3.000,0.053,-0.000,353.39,274.98,1.770,0.160*04 [GPS=28874.382s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874382,3.000,0.053,-0.000,354.00,274.98,1.770,0.160*04 [GPS=28874.382s r=1] STM32 UART5 STATE: $STATE,goto_start,1.235,79.03,28874382*7B [GPS=28874.399s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874399,3.000,0.053,-0.000,354.61,274.98,1.770,0.160*09 [GPS=28874.399s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874399,3.000,0.053,-0.000,355.22,274.98,1.770,0.160*0F [GPS=28874.423s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874423,3.000,0.053,-0.000,346.31,274.98,1.770,0.160*09 [GPS=28874.435s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874435,3.000,0.053,-0.000,346.92,274.98,1.770,0.160*07 [GPS=28874.447s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874447,3.000,0.053,-0.000,347.53,274.98,1.770,0.160*0E [GPS=28874.459s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874459,3.000,0.053,-0.000,348.15,274.98,1.770,0.160*0C [GPS=28874.477s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874477,3.000,0.053,-0.000,348.75,274.98,1.770,0.160*06 [GPS=28874.489s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874489,3.000,0.053,-0.000,349.36,274.98,1.770,0.160*01 [GPS=28874.501s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874501,3.000,0.053,-0.000,349.97,274.98,1.770,0.160*0B [GPS=28874.513s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874513,3.000,0.053,-0.000,350.59,274.98,1.770,0.160*02 [GPS=28874.525s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874525,3.000,0.053,-0.000,341.64,274.98,1.770,0.160*09 [GPS=28874.537s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874537,3.000,0.053,-0.000,342.25,274.98,1.770,0.160*0C [GPS=28874.555s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874555,3.000,0.053,-0.000,342.86,274.98,1.770,0.160*01 [GPS=28874.567s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874567,3.000,0.053,-0.000,343.47,274.98,1.770,0.160*0C [GPS=28874.579s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874579,3.000,0.053,-0.000,344.08,274.98,1.770,0.160*0F [GPS=28874.591s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874591,3.000,0.053,-0.000,344.69,274.98,1.770,0.160*0E [GPS=28874.603s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874603,3.000,0.053,-0.000,345.30,274.98,1.770,0.160*0B [GPS=28874.609s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874609,3.000,0.053,-0.000,345.92,274.98,1.770,0.160*09 [GPS=28874.633s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874633,3.000,0.053,-0.000,336.96,274.98,1.770,0.160*00 [GPS=28874.645s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874645,3.000,0.053,-0.000,337.57,274.98,1.770,0.160*0D [GPS=28874.657s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874657,3.000,0.053,-0.000,338.18,274.98,1.770,0.160*0A [GPS=28874.663s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874663,3.000,0.053,-0.000,338.79,274.98,1.770,0.160*0A [GPS=28874.675s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874675,3.000,0.053,-0.000,339.40,274.98,1.770,0.160*06 [GPS=28874.699s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874699,3.000,0.053,-0.000,340.02,274.98,1.770,0.160*0C [GPS=28874.711s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874711,3.000,0.053,-0.000,340.63,274.98,1.770,0.160*0A [GPS=28874.711s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874711,3.000,0.053,-0.000,332.56,274.98,1.770,0.160*09 [GPS=28874.729s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874729,3.000,0.053,-0.000,333.17,274.98,1.770,0.160*06 [GPS=28874.741s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874741,3.000,0.053,-0.000,333.78,274.98,1.770,0.160*01 [GPS=28874.765s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874765,3.000,0.053,-0.000,334.40,274.98,1.770,0.160*0B [GPS=28874.777s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874777,3.000,0.053,-0.000,335.01,274.98,1.770,0.160*0C [GPS=28874.789s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874789,3.000,0.053,-0.000,335.62,274.98,1.770,0.160*08 [GPS=28874.795s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874795,3.000,0.053,-0.000,336.23,274.98,1.770,0.160*03 [GPS=28874.807s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874807,3.000,0.053,-0.000,336.84,274.98,1.770,0.160*0A [GPS=28874.819s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874819,3.000,0.053,-0.000,327.89,274.98,1.770,0.160*08 [GPS=28874.843s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874843,3.000,0.053,-0.000,328.50,274.98,1.770,0.160*0C [GPS=28874.855s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874855,3.000,0.053,-0.000,329.11,274.98,1.770,0.160*0F [GPS=28874.867s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874867,3.000,0.053,-0.000,329.72,274.98,1.770,0.160*0B [GPS=28874.873s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874873,3.000,0.053,-0.000,330.33,274.98,1.770,0.160*03 [GPS=28874.885s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874885,3.000,0.053,-0.000,330.94,274.98,1.770,0.160*07 [GPS=28874.897s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874897,3.000,0.053,-0.000,331.56,274.98,1.770,0.160*0B [GPS=28874.909s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874909,3.000,0.053,-0.000,332.17,274.98,1.770,0.160*0B [GPS=28874.927s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874927,3.000,0.053,-0.000,323.22,274.98,1.770,0.160*01 [GPS=28874.939s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874939,3.000,0.053,-0.000,323.83,274.98,1.770,0.160*05 [GPS=28874.951s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874951,3.000,0.053,-0.000,324.44,274.98,1.770,0.160*07 [GPS=28874.963s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874963,3.000,0.053,-0.000,325.05,274.98,1.770,0.160*02 [GPS=28874.987s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874987,3.000,0.053,-0.000,325.66,274.98,1.770,0.160*0D [GPS=28874.999s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28874999,3.000,0.053,-0.000,326.27,274.98,1.770,0.160*04 [GPS=28874.999s r=1] STM32 UART5 POSE: $POSE,3.000,0.053,-0.000,326.27,0.00,-0.00,1.770,0.160,28874999*1C [GPS=28875.005s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875005,3.000,0.053,-0.000,326.88,274.98,1.770,0.160*0C [GPS=28875.017s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875017,3.000,0.053,-0.000,327.50,274.98,1.770,0.160*0B [GPS=28875.029s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875029,3.000,0.053,-0.000,318.54,274.98,1.770,0.160*0E [GPS=28875.041s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875041,3.000,0.053,-0.000,319.15,274.98,1.770,0.160*04 [GPS=28875.065s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875065,3.000,0.053,-0.000,319.76,274.98,1.770,0.160*07 [GPS=28875.071s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875071,3.000,0.053,-0.000,320.37,274.98,1.770,0.160*0D [GPS=28875.083s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875083,3.000,0.053,-0.000,320.98,274.98,1.770,0.160*05 [GPS=28875.095s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875095,3.000,0.053,-0.000,321.59,274.98,1.770,0.160*0E [GPS=28875.107s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875107,3.000,0.053,-0.000,322.20,274.98,1.770,0.160*09 [GPS=28875.119s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875119,3.000,0.053,-0.000,313.86,274.98,1.770,0.160*08 [GPS=28875.137s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875137,3.000,0.053,-0.000,314.47,274.98,1.770,0.160*0E [GPS=28875.149s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875149,3.000,0.053,-0.000,315.08,274.98,1.770,0.160*0D [GPS=28875.161s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875161,3.000,0.053,-0.000,315.69,274.98,1.770,0.160*00 [GPS=28875.173s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875173,3.000,0.053,-0.000,316.31,274.98,1.770,0.160*0D [GPS=28875.185s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875185,3.000,0.053,-0.000,316.92,274.98,1.770,0.160*0D [GPS=28875.203s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875203,3.000,0.053,-0.000,317.53,274.98,1.770,0.160*0C [GPS=28875.215s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875215,3.000,0.053,-0.000,318.14,274.98,1.770,0.160*07 [GPS=28875.215s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875215,3.000,0.053,-0.000,309.46,274.98,1.770,0.160*00 [GPS=28875.239s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875239,3.000,0.053,-0.000,310.07,274.98,1.770,0.160*03 [GPS=28875.251s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875251,3.000,0.053,-0.000,310.68,274.98,1.770,0.160*04 [GPS=28875.257s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875257,3.000,0.053,-0.000,311.29,274.98,1.770,0.160*06 [GPS=28875.281s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875281,3.000,0.053,-0.000,311.90,274.98,1.770,0.160*0F [GPS=28875.293s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875293,3.000,0.053,-0.000,312.51,274.98,1.770,0.160*02 [GPS=28875.305s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875305,3.000,0.053,-0.000,313.12,274.98,1.770,0.160*0A [GPS=28875.317s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875317,3.000,0.053,-0.000,313.73,274.98,1.770,0.160*0E [GPS=28875.317s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875317,3.000,0.053,-0.000,304.78,274.98,1.770,0.160*03 [GPS=28875.335s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875335,3.000,0.053,-0.000,305.39,274.98,1.770,0.160*07 [GPS=28875.359s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875359,3.000,0.053,-0.000,306.00,274.98,1.770,0.160*04 [GPS=28875.371s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875371,3.000,0.053,-0.000,306.61,274.98,1.770,0.160*09 [GPS=28875.383s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875383,3.000,0.053,-0.000,307.23,274.98,1.770,0.160*03 [GPS=28875.383s r=1] STM32 UART5 STATE: $STATE,goto_start,1.235,32.25,28875383*70 [GPS=28875.389s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875389,3.000,0.053,-0.000,307.84,274.98,1.770,0.160*04 [GPS=28875.401s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875401,3.000,0.053,-0.000,308.45,274.98,1.770,0.160*01 [GPS=28875.413s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875413,3.000,0.053,-0.000,309.06,274.98,1.770,0.160*04 [GPS=28875.437s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.702,76.92,1159,1500,goto_start,28875437,3.000,0.053,-0.000,300.13,274.98,1.770,0.160*0D [GPS=28875.449s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.719,76.92,1151,1500,goto_start,28875449,3.000,0.053,-0.000,300.74,274.98,1.770,0.160*07 [GPS=28875.461s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.736,76.92,1143,1500,goto_start,28875461,3.000,0.053,-0.000,301.32,274.98,1.770,0.160*00 [GPS=28875.467s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.752,76.92,1135,1500,goto_start,28875467,3.000,0.053,-0.000,301.89,274.98,1.770,0.160*05 [GPS=28875.479s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.767,76.92,1128,1500,goto_start,28875479,3.000,0.053,-0.000,302.45,274.98,1.770,0.160*03 [GPS=28875.503s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.784,76.92,1120,1500,goto_start,28875503,3.000,0.053,-0.000,303.04,274.98,1.770,0.160*0E [GPS=28875.515s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875515,3.000,0.053,-0.000,303.64,274.98,1.770,0.160*0D [GPS=28875.527s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.800,76.92,1112,1500,goto_start,28875527,3.000,0.053,-0.000,304.24,274.98,1.770,0.160*0F [GPS=28875.533s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.577,76.92,1220,1500,goto_start,28875533,3.000,0.053,-0.000,295.63,274.98,1.770,0.160*0F [GPS=28875.545s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.594,76.92,1212,1500,goto_start,28875545,3.000,0.053,-0.000,296.24,274.98,1.770,0.160*02 [GPS=28875.569s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.610,76.92,1204,1500,goto_start,28875569,3.000,0.053,-0.000,296.81,274.98,1.770,0.160*0B [GPS=28875.581s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.625,76.92,1197,1500,goto_start,28875581,3.000,0.053,-0.000,297.35,274.98,1.770,0.160*0C [GPS=28875.593s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.639,76.92,1190,1500,goto_start,28875593,3.000,0.053,-0.000,297.86,274.98,1.770,0.160*0D [GPS=28875.599s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.653,76.92,1183,1500,goto_start,28875599,3.000,0.053,-0.000,298.36,274.98,1.770,0.160*0D [GPS=28875.611s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.667,76.92,1176,1500,goto_start,28875611,3.000,0.053,-0.000,298.85,274.98,1.770,0.160*0B [GPS=28875.623s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.458,76.92,1278,1500,goto_start,28875623,3.000,0.053,-0.000,291.37,274.98,1.770,0.160*09 [GPS=28875.646s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.472,76.92,1271,1500,goto_start,28875646,3.000,0.053,-0.000,291.86,274.98,1.770,0.160*01 [GPS=28875.658s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.485,76.92,1265,1500,goto_start,28875658,3.000,0.053,-0.000,292.33,274.98,1.770,0.160*0E [GPS=28875.664s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.497,76.92,1259,1500,goto_start,28875664,3.000,0.053,-0.000,292.78,274.98,1.770,0.160*02 [GPS=28875.676s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.509,76.92,1253,1500,goto_start,28875676,3.000,0.053,-0.000,293.20,274.98,1.770,0.160*01 [GPS=28875.688s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.520,76.92,1248,1500,goto_start,28875688,3.000,0.053,-0.000,293.59,274.98,1.770,0.160*0F [GPS=28875.712s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.531,76.92,1242,1500,goto_start,28875712,3.000,0.053,-0.000,293.99,274.98,1.770,0.160*0B [GPS=28875.718s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.542,76.92,1237,1500,goto_start,28875718,3.000,0.053,-0.000,294.39,274.98,1.770,0.160*0A [GPS=28875.731s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.368,76.92,1321,1500,goto_start,28875731,3.000,0.053,-0.000,288.15,274.98,1.770,0.160*0A [GPS=28875.742s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.379,76.92,1316,1500,goto_start,28875742,3.000,0.053,-0.000,288.56,274.98,1.770,0.160*0D [GPS=28875.754s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.390,76.92,1311,1500,goto_start,28875754,3.000,0.053,-0.000,288.95,274.98,1.770,0.160*05 [GPS=28875.766s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.400,76.92,1306,1500,goto_start,28875766,3.000,0.053,-0.000,289.30,274.98,1.770,0.160*02 [GPS=28875.790s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.409,76.92,1302,1500,goto_start,28875790,3.000,0.053,-0.000,289.61,274.98,1.770,0.160*02 [GPS=28875.797s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.417,76.92,1298,1500,goto_start,28875797,3.000,0.053,-0.000,289.91,274.98,1.770,0.160*07 [GPS=28875.808s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.426,76.92,1293,1500,goto_start,28875808,3.000,0.053,-0.000,290.23,274.98,1.770,0.160*06 [GPS=28875.820s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.435,76.92,1289,1500,goto_start,28875820,3.000,0.053,-0.000,290.54,274.98,1.770,0.160*05 [GPS=28875.832s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.291,76.92,1359,1175,goto_start,28875832,3.000,0.053,-0.000,285.40,274.98,1.770,0.160*06 [GPS=28875.844s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.300,76.92,1354,1175,goto_start,28875844,3.000,0.053,-0.000,285.73,274.98,1.770,0.160*03 [GPS=28875.862s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.309,76.92,1350,1175,goto_start,28875862,3.000,0.053,-0.000,286.04,274.98,1.770,0.160*09 [GPS=28875.874s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.317,76.92,1346,1175,goto_start,28875874,3.000,0.053,-0.000,286.31,274.98,1.770,0.160*00 [GPS=28875.886s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.324,76.92,1343,1500,goto_start,28875886,3.000,0.053,-0.000,286.56,274.98,1.770,0.160*0C [GPS=28875.898s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.330,76.92,1340,1500,goto_start,28875898,3.000,0.053,-0.000,286.80,274.98,1.770,0.160*0E [GPS=28875.910s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.337,76.92,1336,1500,goto_start,28875910,3.000,0.053,-0.000,287.05,274.98,1.770,0.160*05 [GPS=28875.922s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.344,76.92,1333,1500,goto_start,28875922,3.000,0.053,-0.000,287.30,274.98,1.770,0.160*03 [GPS=28875.940s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.230,76.92,1388,1175,goto_start,28875940,2.997,0.054,-0.000,283.20,274.95,1.770,0.160*09 [GPS=28875.952s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.238,76.92,1385,1175,goto_start,28875952,2.997,0.054,-0.000,283.46,274.95,1.770,0.160*0F [GPS=28875.964s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.244,76.92,1382,1175,goto_start,28875964,2.997,0.054,-0.000,283.69,274.95,1.770,0.160*0B [GPS=28875.976s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.250,76.92,1379,1175,goto_start,28875976,2.997,0.054,-0.000,283.90,274.95,1.770,0.160*0F [GPS=28875.982s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.255,76.92,1376,1175,goto_start,28875982,2.997,0.054,-0.000,284.09,274.95,1.770,0.160*09 [GPS=28875.982s r=1] STM32 UART5 POSE: $POSE,2.997,0.054,-0.000,284.09,-498.27,-2.99,1.770,0.160,28875982*3C [GPS=28876.006s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.261,76.92,1374,1175,goto_start,28876006,2.997,0.054,-0.000,284.28,274.95,1.770,0.160*09 [GPS=28876.018s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.266,76.92,1371,1175,goto_start,28876018,2.997,0.054,-0.000,284.48,274.95,1.770,0.160*02 [GPS=28876.030s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.272,76.92,1368,1175,goto_start,28876030,2.997,0.054,-0.000,284.68,274.95,1.770,0.160*07 [GPS=28876.042s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.183,76.92,1411,1175,goto_start,28876042,2.992,0.055,-0.000,281.49,274.92,1.770,0.160*03 [GPS=28876.048s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.189,76.92,1408,1175,goto_start,28876048,2.992,0.055,-0.000,281.70,274.92,1.770,0.160*01 [GPS=28876.071s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.194,76.92,1406,1175,goto_start,28876071,2.992,0.055,-0.000,281.87,274.92,1.770,0.160*01 [GPS=28876.083s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.198,76.92,1404,1175,goto_start,28876083,2.992,0.055,-0.000,282.01,274.92,1.770,0.160*0F [GPS=28876.095s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.202,76.92,1402,1175,goto_start,28876095,2.992,0.055,-0.000,282.16,274.92,1.770,0.160*08 [GPS=28876.106s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.206,76.92,1400,1175,goto_start,28876106,2.992,0.055,-0.000,282.31,274.92,1.770,0.160*00 [GPS=28876.118s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.211,76.92,1398,1175,goto_start,28876118,2.992,0.055,-0.000,282.46,274.92,1.770,0.160*0F [GPS=28876.124s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.149,76.92,1428,1175,goto_start,28876124,2.973,0.058,-0.000,280.17,274.83,1.770,0.160*06 [GPS=28876.148s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.153,76.92,1426,1175,goto_start,28876148,2.973,0.058,-0.000,280.33,274.83,1.770,0.160*0F [GPS=28876.160s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.157,76.92,1424,1175,goto_start,28876160,2.973,0.058,-0.000,280.46,274.83,1.770,0.160*01 [GPS=28876.172s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.160,76.92,1422,1175,goto_start,28876172,2.973,0.058,-0.000,280.58,274.83,1.770,0.160*0F [GPS=28876.185s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.164,76.92,1420,1175,goto_start,28876185,2.973,0.058,-0.000,280.70,274.83,1.770,0.160*0B [GPS=28876.190s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.167,76.92,1419,1175,goto_start,28876190,2.973,0.058,-0.000,280.82,274.83,1.770,0.160*0B [GPS=28876.214s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.171,76.92,1417,1175,goto_start,28876214,2.973,0.058,-0.000,280.95,274.83,1.770,0.160*0B [GPS=28876.226s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.174,76.92,1415,1175,goto_start,28876226,2.973,0.058,-0.000,281.07,274.83,1.770,0.160*07 [GPS=28876.238s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.124,76.92,1440,1175,goto_start,28876238,2.937,0.064,-0.000,279.13,274.70,1.770,0.160*0C [GPS=28876.244s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.128,76.92,1438,1175,goto_start,28876244,2.937,0.064,-0.000,279.26,274.70,1.770,0.160*02 [GPS=28876.256s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.131,76.92,1436,1175,goto_start,28876256,2.937,0.064,-0.000,279.38,274.70,1.770,0.160*08 [GPS=28876.280s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.134,76.92,1435,1175,goto_start,28876280,2.937,0.064,-0.000,279.48,274.70,1.770,0.160*02 [GPS=28876.292s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.137,76.92,1434,1175,goto_start,28876292,2.937,0.064,-0.000,279.58,274.70,1.770,0.160*02 [GPS=28876.304s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.139,76.92,1432,1175,goto_start,28876304,2.937,0.064,-0.000,279.69,274.70,1.770,0.160*06 [GPS=28876.310s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.142,76.92,1431,1175,goto_start,28876310,2.937,0.064,-0.000,279.79,274.70,1.770,0.160*0D [GPS=28876.322s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.145,76.92,1429,1175,goto_start,28876322,2.937,0.064,-0.000,279.90,274.70,1.770,0.160*05 [GPS=28876.334s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.105,76.92,1449,1175,goto_start,28876334,2.887,0.072,-0.000,278.28,274.52,1.770,0.160*0F [GPS=28876.358s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.108,76.92,1448,1175,goto_start,28876358,2.887,0.072,-0.000,278.37,274.52,1.770,0.160*07 [GPS=28876.370s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.110,76.92,1447,1175,goto_start,28876370,2.887,0.072,-0.000,278.45,274.52,1.770,0.160*0E [GPS=28876.376s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.112,76.92,1446,1175,goto_start,28876376,2.887,0.072,-0.000,278.54,274.52,1.770,0.160*0B [GPS=28876.376s r=1] STM32 UART5 STATE: $STATE,goto_start,1.121,4.02,28876376*4F [GPS=28876.388s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.114,76.92,1444,1175,goto_start,28876388,2.887,0.072,-0.000,278.62,274.52,1.770,0.160*0B [GPS=28876.400s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.117,76.92,1443,1175,goto_start,28876400,2.887,0.072,-0.000,278.71,274.52,1.770,0.160*0A [GPS=28876.412s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.119,76.92,1442,1175,goto_start,28876412,2.887,0.072,-0.000,278.79,274.52,1.770,0.160*0E [GPS=28876.423s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.122,76.92,1441,1175,goto_start,28876423,2.887,0.072,-0.000,278.88,274.52,1.770,0.160*09 [GPS=28876.447s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.090,76.92,1456,1175,goto_start,28876447,2.831,0.079,-0.000,277.58,274.35,1.770,0.160*00 [GPS=28876.459s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.093,76.92,1455,1175,goto_start,28876459,2.831,0.079,-0.000,277.67,274.35,1.770,0.160*03 [GPS=28876.465s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.095,76.92,1454,1175,goto_start,28876465,2.831,0.079,-0.000,277.75,274.35,1.770,0.160*08 [GPS=28876.477s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.097,76.92,1453,1175,goto_start,28876477,2.831,0.079,-0.000,277.82,274.35,1.770,0.160*06 [GPS=28876.501s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.099,76.92,1452,1175,goto_start,28876501,2.831,0.079,-0.000,277.89,274.35,1.770,0.160*02 [GPS=28876.513s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.101,76.92,1451,1175,goto_start,28876513,2.831,0.079,-0.000,277.97,274.35,1.770,0.160*0D [GPS=28876.524s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.103,76.92,1450,1175,goto_start,28876524,2.831,0.079,-0.000,278.04,274.35,1.770,0.160*0F [GPS=28876.536s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.105,76.92,1449,1175,goto_start,28876536,2.831,0.079,-0.000,278.12,274.35,1.770,0.160*05 [GPS=28876.542s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.078,76.92,1462,1175,goto_start,28876542,2.775,0.086,-0.000,276.97,274.19,1.770,0.160*06 [GPS=28876.554s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.080,76.92,1461,1175,goto_start,28876554,2.775,0.086,-0.000,277.05,274.19,1.770,0.160*0F [GPS=28876.578s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.082,76.92,1460,1175,goto_start,28876578,2.775,0.086,-0.000,277.11,274.19,1.770,0.160*07 [GPS=28876.590s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.083,76.92,1460,1175,goto_start,28876590,2.775,0.086,-0.000,277.17,274.19,1.770,0.160*06 [GPS=28876.602s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.085,76.92,1459,1175,goto_start,28876602,2.775,0.086,-0.000,277.23,274.19,1.770,0.160*05 [GPS=28876.608s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.087,76.92,1458,1175,goto_start,28876608,2.775,0.086,-0.000,277.30,274.19,1.770,0.160*0E [GPS=28876.620s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.089,76.92,1457,1175,goto_start,28876620,2.775,0.086,-0.000,277.36,274.19,1.770,0.160*03 [GPS=28876.631s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.090,76.92,1456,1175,goto_start,28876631,2.775,0.086,-0.000,277.43,274.19,1.770,0.160*08 [GPS=28876.655s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.067,76.92,1467,1175,goto_start,28876655,2.719,0.093,-0.000,276.45,274.05,1.770,0.160*04 [GPS=28876.667s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.069,76.92,1467,1175,goto_start,28876667,2.719,0.093,-0.000,276.52,274.05,1.770,0.160*0D [GPS=28876.673s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.071,76.92,1466,1175,goto_start,28876673,2.719,0.093,-0.000,276.57,274.05,1.770,0.160*05 [GPS=28876.685s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.072,76.92,1465,1175,goto_start,28876685,2.719,0.093,-0.000,276.63,274.05,1.770,0.160*0B [GPS=28876.697s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.074,76.92,1464,1175,goto_start,28876697,2.719,0.093,-0.000,276.68,274.05,1.770,0.160*04 [GPS=28876.721s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.075,76.92,1463,1175,goto_start,28876721,2.719,0.093,-0.000,276.74,274.05,1.770,0.160*03 [GPS=28876.727s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.077,76.92,1463,1175,goto_start,28876727,2.719,0.093,-0.000,276.80,274.05,1.770,0.160*0C [GPS=28876.739s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.058,76.92,1472,1175,goto_start,28876739,2.662,0.099,-0.000,275.99,273.91,1.770,0.160*08 [GPS=28876.751s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.060,76.92,1471,1175,goto_start,28876751,2.662,0.099,-0.000,276.05,273.91,1.770,0.160*08 [GPS=28876.763s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.061,76.92,1471,1175,goto_start,28876763,2.662,0.099,-0.000,276.09,273.91,1.770,0.160*04 [GPS=28876.787s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.062,76.92,1470,1175,goto_start,28876787,2.662,0.099,-0.000,276.14,273.91,1.770,0.160*00 [GPS=28876.793s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.063,76.92,1469,1175,goto_start,28876793,2.662,0.099,-0.000,276.18,273.91,1.770,0.160*00 [GPS=28876.805s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.065,76.92,1469,1175,goto_start,28876805,2.662,0.099,-0.000,276.23,273.91,1.770,0.160*0E [GPS=28876.817s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.066,76.92,1468,1175,goto_start,28876817,2.662,0.099,-0.000,276.28,273.91,1.770,0.160*04 [GPS=28876.829s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.067,76.92,1467,1175,goto_start,28876829,2.662,0.099,-0.000,276.33,273.91,1.770,0.160*0D [GPS=28876.841s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.051,76.92,1475,1175,goto_start,28876841,2.609,0.104,-0.000,275.63,273.80,1.770,0.160*0B [GPS=28876.864s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.052,76.92,1475,1175,goto_start,28876864,2.609,0.104,-0.000,275.67,273.80,1.770,0.160*0B [GPS=28876.876s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.053,76.92,1474,1175,goto_start,28876876,2.609,0.104,-0.000,275.70,273.80,1.770,0.160*0E [GPS=28876.882s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.054,76.92,1474,1175,goto_start,28876882,2.609,0.104,-0.000,275.74,273.80,1.770,0.160*06 [GPS=28876.894s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.056,76.92,1473,1175,goto_start,28876894,2.609,0.104,-0.000,275.78,273.80,1.770,0.160*08 [GPS=28876.906s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.057,76.92,1472,1175,goto_start,28876906,2.609,0.104,-0.000,275.83,273.80,1.770,0.160*06 [GPS=28876.918s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.058,76.92,1472,1175,goto_start,28876918,2.609,0.104,-0.000,275.87,273.80,1.770,0.160*02 [GPS=28876.930s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.059,76.92,1471,1175,goto_start,28876930,2.609,0.104,-0.000,275.91,273.80,1.770,0.160*0D [GPS=28876.947s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.045,76.92,1478,1175,goto_start,28876947,2.552,0.110,-0.000,275.29,273.68,1.770,0.160*04 [GPS=28876.959s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.046,76.92,1478,1175,goto_start,28876959,2.552,0.110,-0.000,275.34,273.68,1.770,0.160*04 [GPS=28876.971s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.047,76.92,1477,1175,goto_start,28876971,2.552,0.110,-0.000,275.37,273.68,1.770,0.160*03 [GPS=28876.983s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.048,76.92,1477,1175,goto_start,28876983,2.552,0.110,-0.000,275.41,273.68,1.770,0.160*00 [GPS=28876.983s r=1] STM32 UART5 POSE: $POSE,2.552,0.110,-0.000,275.41,0.00,-10.69,1.770,0.160,28876983*29 [GPS=28877.001s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.049,76.92,1476,1175,goto_start,28877001,2.552,0.110,-0.000,275.44,273.68,1.770,0.160*07 [GPS=28877.013s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.050,76.92,1476,1175,goto_start,28877013,2.552,0.110,-0.000,275.48,273.68,1.770,0.160*00 [GPS=28877.025s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.051,76.92,1475,1175,goto_start,28877025,2.552,0.110,-0.000,275.52,273.68,1.770,0.160*0C [GPS=28877.037s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.052,76.92,1475,1175,goto_start,28877037,2.552,0.110,-0.000,275.56,273.68,1.770,0.160*08 [GPS=28877.049s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.040,76.92,1481,1175,goto_start,28877049,2.496,0.115,-0.000,275.00,273.57,1.770,0.160*0A [GPS=28877.073s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.041,76.92,1480,1175,goto_start,28877073,2.496,0.115,-0.000,275.03,273.57,1.770,0.160*00 [GPS=28877.079s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.041,76.92,1480,1175,goto_start,28877079,2.496,0.115,-0.000,275.06,273.57,1.770,0.160*0F [GPS=28877.091s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.042,76.92,1479,1175,goto_start,28877091,2.496,0.115,-0.000,275.09,273.57,1.770,0.160*03 [GPS=28877.103s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.043,76.92,1479,1175,goto_start,28877103,2.496,0.115,-0.000,275.12,273.57,1.770,0.160*02 [GPS=28877.115s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.044,76.92,1479,1175,goto_start,28877115,2.496,0.115,-0.000,275.15,273.57,1.770,0.160*05 [GPS=28877.127s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.045,76.92,1478,1175,goto_start,28877127,2.496,0.115,-0.000,275.18,273.57,1.770,0.160*09 [GPS=28877.139s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.035,76.92,1483,1175,goto_start,28877139,2.439,0.120,0.000,274.73,273.46,1.770,0.160*27 [GPS=28877.157s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.036,76.92,1482,1175,goto_start,28877157,2.439,0.120,0.000,274.77,273.46,1.770,0.160*29 [GPS=28877.169s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.037,76.92,1482,1175,goto_start,28877169,2.439,0.120,0.000,274.79,273.46,1.770,0.160*2B [GPS=28877.181s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.038,76.92,1482,1175,goto_start,28877181,2.439,0.120,0.000,274.82,273.46,1.770,0.160*26 [GPS=28877.192s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.039,76.92,1481,1175,goto_start,28877192,2.439,0.120,0.000,274.85,273.46,1.770,0.160*21 [GPS=28877.210s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.040,76.92,1481,1175,goto_start,28877210,2.439,0.120,0.000,274.88,273.46,1.770,0.160*2B [GPS=28877.222s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.040,76.92,1480,1175,goto_start,28877222,2.439,0.120,0.000,274.91,273.46,1.770,0.160*23 [GPS=28877.234s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.041,76.92,1480,1175,goto_start,28877234,2.439,0.120,0.000,274.94,273.46,1.770,0.160*20 [GPS=28877.246s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.032,76.92,1485,1175,goto_start,28877246,2.383,0.124,0.000,274.50,273.36,1.770,0.160*29 [GPS=28877.258s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.033,76.92,1484,1175,goto_start,28877258,2.383,0.124,0.000,274.54,273.36,1.770,0.160*22 [GPS=28877.264s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.033,76.92,1484,1175,goto_start,28877264,2.383,0.124,0.000,274.56,273.36,1.770,0.160*2F [GPS=28877.288s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.034,76.92,1483,1175,goto_start,28877288,2.383,0.124,0.000,274.58,273.36,1.770,0.160*23 [GPS=28877.300s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.035,76.92,1483,1175,goto_start,28877300,2.383,0.124,0.000,274.61,273.36,1.770,0.160*29 [GPS=28877.312s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.036,76.92,1483,1175,goto_start,28877312,2.383,0.124,0.000,274.63,273.36,1.770,0.160*2B [GPS=28877.324s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.036,76.92,1482,1175,goto_start,28877324,2.383,0.124,0.000,274.66,273.36,1.770,0.160*2A [GPS=28877.336s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.037,76.92,1482,1175,goto_start,28877336,2.383,0.124,0.000,274.69,273.36,1.770,0.160*27 [GPS=28877.354s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.029,76.92,1486,1175,goto_start,28877354,2.326,0.128,0.000,274.29,273.26,1.770,0.160*2E [GPS=28877.366s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.030,76.92,1486,1175,goto_start,28877366,2.326,0.128,0.000,274.33,273.26,1.770,0.160*2C [GPS=28877.378s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.030,76.92,1485,1175,goto_start,28877378,2.326,0.128,0.000,274.35,273.26,1.770,0.160*26 [GPS=28877.378s r=1] STM32 UART5 STATE: $STATE,goto_start,0.557,1.09,28877378*4A [GPS=28877.390s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.031,76.92,1485,1175,goto_start,28877390,2.326,0.128,0.000,274.37,273.26,1.770,0.160*23 [GPS=28877.402s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.032,76.92,1485,1175,goto_start,28877402,2.326,0.128,0.000,274.39,273.26,1.770,0.160*22 [GPS=28877.419s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.032,76.92,1484,1175,goto_start,28877419,2.326,0.128,0.000,274.42,273.26,1.770,0.160*25 [GPS=28877.431s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.033,76.92,1484,1175,goto_start,28877431,2.326,0.128,0.000,274.44,273.26,1.770,0.160*28 [GPS=28877.443s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.034,76.92,1484,1175,goto_start,28877443,2.326,0.128,0.000,274.47,273.26,1.770,0.160*29 [GPS=28877.455s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877455,2.269,0.132,0.000,274.11,273.16,1.770,0.160*2E [GPS=28877.461s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877461,2.269,0.132,0.000,274.13,273.16,1.770,0.160*2B [GPS=28877.473s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.028,76.92,1487,1175,goto_start,28877473,2.269,0.132,0.000,274.15,273.16,1.770,0.160*21 [GPS=28877.497s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.028,76.92,1486,1175,goto_start,28877497,2.269,0.132,0.000,274.18,273.16,1.770,0.160*27 [GPS=28877.509s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.029,76.92,1486,1175,goto_start,28877509,2.269,0.132,0.000,274.20,273.16,1.770,0.160*2B [GPS=28877.521s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.030,76.92,1486,1175,goto_start,28877521,2.269,0.132,0.000,274.22,273.16,1.770,0.160*2B [GPS=28877.527s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.030,76.92,1485,1175,goto_start,28877527,2.269,0.132,0.000,274.24,273.16,1.770,0.160*28 [GPS=28877.539s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.031,76.92,1485,1175,goto_start,28877539,2.269,0.132,0.000,274.26,273.16,1.770,0.160*24 [GPS=28877.551s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877551,2.212,0.136,0.000,273.93,273.05,1.770,0.160*21 [GPS=28877.575s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877575,2.212,0.136,0.000,273.96,273.05,1.770,0.160*22 [GPS=28877.587s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877587,2.212,0.136,0.000,273.97,273.05,1.770,0.160*22 [GPS=28877.593s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877593,2.212,0.136,0.000,273.99,273.05,1.770,0.160*29 [GPS=28877.605s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877605,2.212,0.136,0.000,274.01,273.05,1.770,0.160*22 [GPS=28877.617s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877617,2.212,0.136,0.000,274.03,273.05,1.770,0.160*23 [GPS=28877.629s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.028,76.92,1486,1175,goto_start,28877629,2.212,0.136,0.000,274.05,273.05,1.770,0.160*26 [GPS=28877.641s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.023,76.92,1489,1175,goto_start,28877641,2.159,0.140,0.000,273.78,272.94,1.770,0.160*25 [GPS=28877.665s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1488,1175,goto_start,28877665,2.159,0.140,0.000,273.80,272.94,1.770,0.160*22 [GPS=28877.671s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1488,1175,goto_start,28877671,2.159,0.140,0.000,273.82,272.94,1.770,0.160*25 [GPS=28877.683s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877683,2.159,0.140,0.000,273.83,272.94,1.770,0.160*28 [GPS=28877.695s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877695,2.159,0.140,0.000,273.85,272.94,1.770,0.160*29 [GPS=28877.719s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877719,2.159,0.140,0.000,273.88,272.94,1.770,0.160*2D [GPS=28877.731s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877731,2.159,0.140,0.000,273.90,272.94,1.770,0.160*2F [GPS=28877.737s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877737,2.159,0.140,0.000,273.92,272.94,1.770,0.160*2B [GPS=28877.749s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.023,76.92,1489,1175,goto_start,28877749,2.102,0.144,0.000,273.63,272.82,1.770,0.160*2B [GPS=28877.761s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.023,76.92,1489,1175,goto_start,28877761,2.102,0.144,0.000,273.65,272.82,1.770,0.160*27 [GPS=28877.773s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1488,1175,goto_start,28877773,2.102,0.144,0.000,273.67,272.82,1.770,0.160*20 [GPS=28877.797s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1488,1175,goto_start,28877797,2.102,0.144,0.000,273.69,272.82,1.770,0.160*24 [GPS=28877.803s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877803,2.102,0.144,0.000,273.70,272.82,1.770,0.160*2F [GPS=28877.815s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877815,2.102,0.144,0.000,273.72,272.82,1.770,0.160*2A [GPS=28877.827s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877827,2.102,0.144,0.000,273.74,272.82,1.770,0.160*21 [GPS=28877.839s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877839,2.102,0.144,0.000,273.76,272.82,1.770,0.160*2C [GPS=28877.857s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.023,76.92,1489,1175,goto_start,28877857,2.045,0.147,0.000,273.49,272.67,1.770,0.160*29 [GPS=28877.869s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1489,1175,goto_start,28877869,2.045,0.147,0.000,273.51,272.67,1.770,0.160*2A [GPS=28877.881s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.024,76.92,1488,1175,goto_start,28877881,2.045,0.147,0.000,273.53,272.67,1.770,0.160*2F [GPS=28877.893s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877893,2.045,0.147,0.000,273.55,272.67,1.770,0.160*2B [GPS=28877.905s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.025,76.92,1488,1175,goto_start,28877905,2.045,0.147,0.000,273.57,272.67,1.770,0.160*27 [GPS=28877.917s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1488,1175,goto_start,28877917,2.045,0.147,0.000,273.58,272.67,1.770,0.160*28 [GPS=28877.935s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.026,76.92,1487,1175,goto_start,28877935,2.045,0.147,0.000,273.60,272.67,1.770,0.160*2C [GPS=28877.935s r=1] STM32 UART5 CTRL: $CTRL,0.560,0.027,76.92,1487,1175,goto_start,28877935,2.045,0.147,0.000,273.62,272.67,1.770,0.160*2F [GPS=28877.959s r=1] STM32 UART5 CTRL: $CTRL,0.000,0.024,76.92,1488,1500,follow_path,28877959,1.988,0.151,0.000,273.34,272.48,1.770,0.160*41 [GPS=28877.971s r=1] STM32 UART5 CTRL: $CTRL,0.354,0.096,76.92,1453,1280,follow_path,28877971,1.988,0.151,0.000,273.36,272.48,1.770,0.160*4B [GPS=28877.983s r=1] STM32 UART5 CTRL: $CTRL,0.353,-0.186,76.92,1593,1280,follow_path,28877983,1.988,0.151,0.000,273.38,272.48,1.770,0.160*6F [GPS=28877.983s r=1] STM32 UART5 POSE: $POSE,1.988,0.151,0.000,273.38,0.00,-4.87,1.770,0.160,28877983*35 [GPS=28878.001s r=1] STM32 UART5 CTRL: $CTRL,0.353,-0.181,76.92,1590,1281,follow_path,28878001,1.988,0.151,0.000,273.42,272.48,1.770,0.160*6B [GPS=28878.013s r=1] STM32 UART5 CTRL: $CTRL,0.353,-0.190,76.92,1594,1281,follow_path,28878013,1.988,0.151,0.000,273.42,272.48,1.770,0.160*6C [GPS=28878.025s r=1] STM32 UART5 CTRL: $CTRL,0.353,-0.200,76.92,1600,1281,follow_path,28878025,1.988,0.151,0.000,273.40,272.48,1.770,0.160*6F [GPS=28878.037s r=1] STM32 UART5 CTRL: $CTRL,0.354,-0.211,76.92,1605,1280,follow_path,28878037,1.988,0.151,0.000,273.34,272.48,1.770,0.160*6C [GPS=28878.048s r=1] STM32 UART5 CTRL: $CTRL,0.355,-0.222,76.92,1611,1280,follow_path,28878048,1.988,0.151,0.000,273.26,272.48,1.770,0.160*63 [GPS=28878.054s r=1] STM32 UART5 CTRL: $CTRL,0.373,-0.067,76.92,1533,1270,follow_path,28878054,1.936,0.154,0.000,273.23,272.23,1.770,0.160*6D [GPS=28878.078s r=1] STM32 UART5 CTRL: $CTRL,0.375,-0.192,76.92,1596,1270,follow_path,28878078,1.936,0.154,0.000,273.08,272.23,1.770,0.160*68 [GPS=28878.090s r=1] STM32 UART5 CTRL: $CTRL,0.376,-0.187,76.92,1593,1269,follow_path,28878090,1.936,0.154,0.000,272.96,272.23,1.770,0.160*62 [GPS=28878.102s r=1] STM32 UART5 CTRL: $CTRL,0.378,-0.198,76.92,1598,1268,follow_path,28878102,1.936,0.154,0.000,272.81,272.23,1.770,0.160*64 [GPS=28878.114s r=1] STM32 UART5 CTRL: $CTRL,0.379,-0.200,76.92,1599,1267,follow_path,28878114,1.936,0.154,0.000,272.67,272.23,1.770,0.160*66 [GPS=28878.120s r=1] STM32 UART5 CTRL: $CTRL,0.381,-0.207,76.92,1603,1267,follow_path,28878120,1.936,0.154,0.000,272.52,272.23,1.770,0.160*67 [GPS=28878.132s r=1] STM32 UART5 CTRL: $CTRL,0.382,-0.212,76.92,1605,1266,follow_path,28878132,1.936,0.154,0.000,272.37,272.23,1.770,0.160*67 [GPS=28878.156s r=1] STM32 UART5 CTRL: $CTRL,0.373,0.727,76.92,1147,1270,follow_path,28878156,1.896,0.156,0.000,274.24,271.72,1.770,0.160*49 [GPS=28878.168s r=1] STM32 UART5 CTRL: $CTRL,0.375,-0.113,76.92,1556,1270,follow_path,28878168,1.896,0.156,0.000,274.08,271.72,1.770,0.160*64 [GPS=28878.180s r=1] STM32 UART5 CTRL: $CTRL,0.376,-0.107,76.92,1553,1269,follow_path,28878180,1.896,0.156,0.000,273.95,271.72,1.770,0.160*6A [GPS=28878.186s r=1] STM32 UART5 CTRL: $CTRL,0.377,-0.106,76.92,1553,1268,follow_path,28878186,1.896,0.156,0.000,273.83,271.72,1.770,0.160*6A [GPS=28878.198s r=1] STM32 UART5 CTRL: $CTRL,0.378,-0.099,76.92,1549,1268,follow_path,28878198,1.896,0.156,0.000,273.74,271.72,1.770,0.160*6E [GPS=28878.222s r=1] STM32 UART5 CTRL: $CTRL,0.379,-0.098,76.92,1549,1267,follow_path,28878222,1.896,0.156,0.000,273.66,271.72,1.770,0.160*60 [GPS=28878.235s r=1] STM32 UART5 CTRL: $CTRL,0.380,-0.098,76.92,1549,1267,follow_path,28878235,1.896,0.156,0.000,273.59,271.72,1.770,0.160*6C [GPS=28878.247s r=1] STM32 UART5 CTRL: $CTRL,0.381,-0.100,76.92,1550,1266,follow_path,28878247,1.896,0.156,0.000,273.51,271.72,1.770,0.160*69 [GPS=28878.252s r=1] STM32 UART5 CTRL: $CTRL,0.249,0.800,76.92,1112,1334,follow_path,28878252,1.858,0.160,0.000,275.13,259.27,1.280,0.050*4D [GPS=28878.264s r=1] STM32 UART5 CTRL: $CTRL,0.250,0.328,76.92,1341,1333,follow_path,28878264,1.858,0.160,0.000,275.05,259.27,1.280,0.050*45 [GPS=28878.276s r=1] STM32 UART5 CTRL: $CTRL,0.250,0.331,76.92,1339,1333,follow_path,28878276,1.858,0.160,0.000,274.99,259.27,1.280,0.050*45 [GPS=28878.300s r=1] STM32 UART5 CTRL: $CTRL,0.250,0.349,76.92,1330,1333,follow_path,28878300,1.858,0.160,0.000,274.99,259.27,1.280,0.050*43 [GPS=28878.312s r=1] STM32 UART5 CTRL: $CTRL,0.250,0.360,76.92,1325,1333,follow_path,28878312,1.858,0.160,0.000,275.01,259.27,1.280,0.050*4F [GPS=28878.324s r=1] STM32 UART5 CTRL: $CTRL,0.249,0.370,76.92,1320,1333,follow_path,28878324,1.858,0.160,0.000,275.06,259.27,1.280,0.050*41 [GPS=28878.330s r=1] STM32 UART5 CTRL: $CTRL,0.249,0.377,76.92,1317,1334,follow_path,28878330,1.858,0.160,0.000,275.13,259.27,1.280,0.050*44 [GPS=28878.342s r=1] STM32 UART5 CTRL: $CTRL,0.248,0.389,76.92,1311,1334,follow_path,28878342,1.858,0.160,0.000,275.23,259.27,1.280,0.050*44 [GPS=28878.366s r=1] STM32 UART5 CTRL: $CTRL,0.250,0.742,76.92,1140,1333,follow_path,28878366,1.826,0.162,0.000,275.32,258.37,1.280,0.050*42 [GPS=28878.378s r=1] STM32 UART5 CTRL: $CTRL,0.248,0.483,76.92,1266,1334,follow_path,28878378,1.826,0.162,0.000,275.51,258.37,1.280,0.050*4F [GPS=28878.378s r=1] STM32 UART5 STATE: $STATE,follow_path,0.056,17.14,28878378*15 [GPS=28878.390s r=1] STM32 UART5 CTRL: $CTRL,0.246,0.497,76.92,1259,1335,follow_path,28878390,1.826,0.162,0.000,275.72,258.37,1.280,0.050*4E [GPS=28878.396s r=1] STM32 UART5 CTRL: $CTRL,0.243,0.508,76.92,1253,1336,follow_path,28878396,1.826,0.162,0.000,275.94,258.37,1.280,0.050*4B [GPS=28878.407s r=1] STM32 UART5 CTRL: $CTRL,0.241,0.523,76.92,1246,1338,follow_path,28878407,1.826,0.162,0.000,276.19,258.37,1.280,0.050*43 [GPS=28878.430s r=1] STM32 UART5 CTRL: $CTRL,0.238,0.550,76.92,1233,1339,follow_path,28878430,1.826,0.162,0.000,276.50,258.37,1.280,0.050*43 [GPS=28878.442s r=1] STM32 UART5 CTRL: $CTRL,0.234,0.569,76.92,1224,1341,follow_path,28878442,1.826,0.162,0.000,276.83,258.37,1.280,0.050*47 [GPS=28878.442s r=1] STM32 UART5 CTRL: $CTRL,0.269,-0.362,76.92,1680,1324,follow_path,28878442,1.802,0.164,0.000,273.73,257.64,1.280,0.050*65 [GPS=28878.460s r=1] STM32 UART5 CTRL: $CTRL,0.265,0.551,76.92,1232,1326,follow_path,28878460,1.802,0.164,0.000,274.11,257.64,1.280,0.050*4E [GPS=28878.472s r=1] STM32 UART5 CTRL: $CTRL,0.261,0.562,76.92,1227,1328,follow_path,28878472,1.802,0.164,0.000,274.48,257.64,1.280,0.050*4F [GPS=28878.484s r=1] STM32 UART5 CTRL: $CTRL,0.257,0.572,76.92,1222,1330,follow_path,28878484,1.802,0.164,0.000,274.86,257.64,1.280,0.050*4C [GPS=28878.508s r=1] STM32 UART5 CTRL: $CTRL,0.252,0.604,76.92,1207,1332,follow_path,28878508,1.802,0.164,0.000,275.30,257.64,1.280,0.050*47 [GPS=28878.520s r=1] STM32 UART5 CTRL: $CTRL,0.248,0.622,76.92,1198,1334,follow_path,28878520,1.802,0.164,0.000,275.75,257.64,1.280,0.050*40 [GPS=28878.526s r=1] STM32 UART5 CTRL: $CTRL,0.243,0.638,76.92,1190,1337,follow_path,28878526,1.802,0.164,0.000,276.22,257.64,1.280,0.050*4C [GPS=28878.538s r=1] STM32 UART5 CTRL: $CTRL,0.238,0.655,76.92,1182,1339,follow_path,28878538,1.802,0.164,0.000,276.69,257.64,1.280,0.050*46 [GPS=28878.550s r=1] STM32 UART5 CTRL: $CTRL,0.233,0.673,76.92,1173,1342,follow_path,28878550,1.802,0.164,0.000,277.18,257.64,1.280,0.050*42 [GPS=28878.562s r=1] STM32 UART5 CTRL: $CTRL,0.303,-0.800,76.92,1898,1306,follow_path,28878562,1.776,0.165,0.000,270.67,256.94,1.280,0.050*66 [GPS=28878.586s r=1] STM32 UART5 CTRL: $CTRL,0.298,0.569,76.92,1224,1309,follow_path,28878586,1.776,0.165,0.000,271.17,256.94,1.280,0.050*44 [GPS=28878.592s r=1] STM32 UART5 CTRL: $CTRL,0.293,0.578,76.92,1219,1311,follow_path,28878592,1.776,0.165,0.000,271.66,256.94,1.280,0.050*4B [GPS=28878.603s r=1] STM32 UART5 CTRL: $CTRL,0.288,0.581,76.92,1218,1314,follow_path,28878603,1.776,0.165,0.000,272.12,256.94,1.280,0.050*48 [GPS=28878.616s r=1] STM32 UART5 CTRL: $CTRL,0.283,0.589,76.92,1214,1316,follow_path,28878616,1.776,0.165,0.000,272.56,256.94,1.280,0.050*41 [GPS=28878.627s r=1] STM32 UART5 CTRL: $CTRL,0.279,0.601,76.92,1208,1319,follow_path,28878627,1.776,0.165,0.000,273.00,256.94,1.280,0.050*45 [GPS=28878.639s r=1] STM32 UART5 CTRL: $CTRL,0.274,0.616,76.92,1201,1321,follow_path,28878639,1.776,0.165,0.000,273.45,256.94,1.280,0.050*42 [GPS=28878.657s r=1] STM32 UART5 CTRL: $CTRL,0.334,-0.800,76.92,1898,1290,follow_path,28878657,1.750,0.164,0.000,267.05,256.33,1.280,0.050*63 [GPS=28878.669s r=1] STM32 UART5 CTRL: $CTRL,0.329,0.475,76.92,1270,1293,follow_path,28878669,1.750,0.164,0.000,267.52,256.33,1.280,0.050*4C [GPS=28878.682s r=1] STM32 UART5 CTRL: $CTRL,0.325,0.478,76.92,1268,1295,follow_path,28878682,1.750,0.164,0.000,267.96,256.33,1.280,0.050*4F [GPS=28878.693s r=1] STM32 UART5 CTRL: $CTRL,0.320,0.480,76.92,1267,1297,follow_path,28878693,1.750,0.164,0.000,268.37,256.33,1.280,0.050*44 [GPS=28878.717s r=1] STM32 UART5 CTRL: $CTRL,0.317,0.476,76.92,1269,1299,follow_path,28878717,1.750,0.164,0.000,268.74,256.33,1.280,0.050*43 [GPS=28878.723s r=1] STM32 UART5 CTRL: $CTRL,0.313,0.485,76.92,1265,1301,follow_path,28878723,1.750,0.164,0.000,269.10,256.33,1.280,0.050*43 [GPS=28878.735s r=1] STM32 UART5 CTRL: $CTRL,0.309,0.495,76.92,1260,1303,follow_path,28878735,1.750,0.164,0.000,269.47,256.33,1.280,0.050*4B [GPS=28878.747s r=1] STM32 UART5 CTRL: $CTRL,0.305,0.507,76.92,1254,1305,follow_path,28878747,1.750,0.164,0.000,269.84,256.33,1.280,0.050*46 [GPS=28878.759s r=1] STM32 UART5 CTRL: $CTRL,0.360,-0.800,76.92,1898,1277,follow_path,28878759,1.719,0.161,-0.000,263.87,255.74,1.280,0.050*4F [GPS=28878.771s r=1] STM32 UART5 CTRL: $CTRL,0.356,0.377,76.92,1317,1279,follow_path,28878771,1.719,0.161,-0.000,264.26,255.74,1.280,0.050*68 [GPS=28878.789s r=1] STM32 UART5 CTRL: $CTRL,0.352,0.378,76.92,1317,1281,follow_path,28878789,1.719,0.161,-0.000,264.62,255.74,1.280,0.050*63 [GPS=28878.801s r=1] STM32 UART5 CTRL: $CTRL,0.349,0.378,76.92,1316,1283,follow_path,28878801,1.719,0.161,-0.000,264.95,255.74,1.280,0.050*6D [GPS=28878.813s r=1] STM32 UART5 CTRL: $CTRL,0.345,0.376,76.92,1317,1284,follow_path,28878813,1.719,0.161,-0.000,265.25,255.74,1.280,0.050*60 [GPS=28878.825s r=1] STM32 UART5 CTRL: $CTRL,0.342,0.381,76.92,1315,1286,follow_path,28878825,1.719,0.161,-0.000,265.54,255.74,1.280,0.050*6C [GPS=28878.837s r=1] STM32 UART5 CTRL: $CTRL,0.339,0.388,76.92,1311,1288,follow_path,28878837,1.719,0.161,-0.000,265.83,255.74,1.280,0.050*6A [GPS=28878.849s r=1] STM32 UART5 CTRL: $CTRL,0.336,0.398,76.92,1307,1289,follow_path,28878849,1.719,0.161,-0.000,266.12,255.74,1.280,0.050*60 [GPS=28878.867s r=1] STM32 UART5 CTRL: $CTRL,0.381,-0.800,76.92,1898,1267,follow_path,28878867,1.685,0.157,-0.000,261.28,255.23,1.280,0.050*47 [GPS=28878.879s r=1] STM32 UART5 CTRL: $CTRL,0.377,0.292,76.92,1358,1268,follow_path,28878879,1.685,0.157,-0.000,261.59,255.23,1.280,0.050*63 [GPS=28878.891s r=1] STM32 UART5 CTRL: $CTRL,0.374,0.290,76.92,1359,1270,follow_path,28878891,1.685,0.157,-0.000,261.86,255.23,1.280,0.050*6E [GPS=28878.903s r=1] STM32 UART5 CTRL: $CTRL,0.372,0.288,76.92,1360,1271,follow_path,28878903,1.685,0.157,-0.000,262.11,255.23,1.280,0.050*6D [GPS=28878.915s r=1] STM32 UART5 CTRL: $CTRL,0.370,0.285,76.92,1361,1272,follow_path,28878915,1.685,0.157,-0.000,262.33,255.23,1.280,0.050*67 [GPS=28878.933s r=1] STM32 UART5 CTRL: $CTRL,0.367,0.291,76.92,1359,1273,follow_path,28878933,1.685,0.157,-0.000,262.54,255.23,1.280,0.050*6B [GPS=28878.945s r=1] STM32 UART5 CTRL: $CTRL,0.365,0.297,76.92,1356,1274,follow_path,28878945,1.685,0.157,-0.000,262.76,255.23,1.280,0.050*66 [GPS=28878.945s r=1] STM32 UART5 CTRL: $CTRL,0.396,-0.800,76.92,1898,1259,follow_path,28878945,1.649,0.150,-0.000,259.28,254.79,1.280,0.050*4F [GPS=28878.969s r=1] STM32 UART5 CTRL: $CTRL,0.394,0.223,76.92,1392,1260,follow_path,28878969,1.649,0.150,-0.000,259.51,254.79,1.280,0.050*60 [GPS=28878.981s r=1] STM32 UART5 CTRL: $CTRL,0.392,0.219,76.92,1394,1261,follow_path,28878981,1.649,0.150,-0.000,259.71,254.79,1.280,0.050*6C [GPS=28878.981s r=1] STM32 UART5 POSE: $POSE,1.649,0.150,-0.000,259.71,0.00,-35.75,1.280,0.050,28878981*24 [GPS=28878.987s r=1] STM32 UART5 CTRL: $CTRL,0.390,0.219,76.92,1394,1262,follow_path,28878987,1.649,0.150,-0.000,259.89,254.79,1.280,0.050*6C [GPS=28879.011s r=1] STM32 UART5 CTRL: $CTRL,0.388,0.218,76.92,1394,1263,follow_path,28879011,1.649,0.150,-0.000,260.05,254.79,1.280,0.050*6C [GPS=28879.023s r=1] STM32 UART5 CTRL: $CTRL,0.386,0.222,76.92,1392,1264,follow_path,28879023,1.649,0.150,-0.000,260.22,254.79,1.280,0.050*6E [GPS=28879.035s r=1] STM32 UART5 CTRL: $CTRL,0.385,0.228,76.92,1389,1264,follow_path,28879035,1.649,0.150,-0.000,260.38,254.79,1.280,0.050*61 [GPS=28879.047s r=1] STM32 UART5 CTRL: $CTRL,0.383,0.233,76.92,1387,1265,follow_path,28879047,1.649,0.150,-0.000,260.55,254.79,1.280,0.050*6C [GPS=28879.047s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.616,76.92,1807,1254,follow_path,28879047,1.613,0.143,-0.000,257.94,254.41,1.280,0.050*46 [GPS=28879.071s r=1] STM32 UART5 CTRL: $CTRL,0.404,0.179,76.92,1413,1255,follow_path,28879071,1.613,0.143,-0.000,258.11,254.41,1.280,0.050*68 [GPS=28879.089s r=1] STM32 UART5 CTRL: $CTRL,0.403,0.169,76.92,1418,1255,follow_path,28879089,1.613,0.143,-0.000,258.25,254.41,1.280,0.050*65 [GPS=28879.100s r=1] STM32 UART5 CTRL: $CTRL,0.401,0.173,76.92,1416,1256,follow_path,28879100,1.613,0.143,-0.000,258.38,254.41,1.280,0.050*6D [GPS=28879.112s r=1] STM32 UART5 CTRL: $CTRL,0.400,0.175,76.92,1415,1257,follow_path,28879112,1.613,0.143,-0.000,258.51,254.41,1.280,0.050*64 [GPS=28879.124s r=1] STM32 UART5 CTRL: $CTRL,0.399,0.179,76.92,1413,1257,follow_path,28879124,1.613,0.143,-0.000,258.65,254.41,1.280,0.050*6B [GPS=28879.130s r=1] STM32 UART5 CTRL: $CTRL,0.397,0.184,76.92,1411,1258,follow_path,28879130,1.613,0.143,-0.000,258.78,254.41,1.280,0.050*63 [GPS=28879.142s r=1] STM32 UART5 CTRL: $CTRL,0.396,0.188,76.92,1409,1259,follow_path,28879142,1.613,0.143,-0.000,258.92,254.41,1.280,0.050*67 [GPS=28879.166s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.477,76.92,1737,1249,follow_path,28879166,1.573,0.134,-0.000,256.81,254.05,1.280,0.050*42 [GPS=28879.178s r=1] STM32 UART5 CTRL: $CTRL,0.413,0.146,76.92,1429,1250,follow_path,28879178,1.573,0.134,-0.000,256.95,254.05,1.280,0.050*61 [GPS=28879.190s r=1] STM32 UART5 CTRL: $CTRL,0.411,0.139,76.92,1433,1251,follow_path,28879190,1.573,0.134,-0.000,257.07,254.05,1.280,0.050*6D [GPS=28879.196s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.142,76.92,1431,1251,follow_path,28879196,1.573,0.134,-0.000,257.18,254.05,1.280,0.050*6A [GPS=28879.208s r=1] STM32 UART5 CTRL: $CTRL,0.409,0.141,76.92,1432,1252,follow_path,28879208,1.573,0.134,-0.000,257.28,254.05,1.280,0.050*66 [GPS=28879.232s r=1] STM32 UART5 CTRL: $CTRL,0.408,0.146,76.92,1429,1253,follow_path,28879232,1.573,0.134,-0.000,257.39,254.05,1.280,0.050*62 [GPS=28879.244s r=1] STM32 UART5 CTRL: $CTRL,0.407,0.149,76.92,1428,1253,follow_path,28879244,1.573,0.134,-0.000,257.50,254.05,1.280,0.050*6D [GPS=28879.256s r=1] STM32 UART5 CTRL: $CTRL,0.406,0.154,76.92,1425,1254,follow_path,28879256,1.573,0.134,-0.000,257.61,254.05,1.280,0.050*6B [GPS=28879.262s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.381,76.92,1690,1246,follow_path,28879262,1.533,0.124,-0.000,255.88,253.72,1.280,0.050*46 [GPS=28879.274s r=1] STM32 UART5 CTRL: $CTRL,0.419,0.119,76.92,1442,1247,follow_path,28879274,1.533,0.124,-0.000,255.99,253.72,1.280,0.050*68 [GPS=28879.298s r=1] STM32 UART5 CTRL: $CTRL,0.419,0.113,76.92,1445,1247,follow_path,28879298,1.533,0.124,-0.000,256.08,253.72,1.280,0.050*6C [GPS=28879.310s r=1] STM32 UART5 CTRL: $CTRL,0.418,0.113,76.92,1445,1248,follow_path,28879310,1.533,0.124,-0.000,256.17,253.72,1.280,0.050*6D [GPS=28879.322s r=1] STM32 UART5 CTRL: $CTRL,0.417,0.116,76.92,1444,1248,follow_path,28879322,1.533,0.124,-0.000,256.26,253.72,1.280,0.050*65 [GPS=28879.328s r=1] STM32 UART5 CTRL: $CTRL,0.416,0.119,76.92,1442,1249,follow_path,28879328,1.533,0.124,-0.000,256.35,253.72,1.280,0.050*64 [GPS=28879.340s r=1] STM32 UART5 CTRL: $CTRL,0.415,0.121,76.92,1441,1249,follow_path,28879340,1.533,0.124,-0.000,256.43,253.72,1.280,0.050*60 [GPS=28879.352s r=1] STM32 UART5 CTRL: $CTRL,0.414,0.125,76.92,1439,1250,follow_path,28879352,1.533,0.124,-0.000,256.53,253.72,1.280,0.050*60 [GPS=28879.376s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.292,76.92,1645,1243,follow_path,28879376,1.492,0.113,-0.000,255.13,253.41,1.280,0.050*47 [GPS=28879.376s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.015,1.72,28879376*07 [GPS=28879.388s r=1] STM32 UART5 CTRL: $CTRL,0.425,0.093,76.92,1455,1244,follow_path,28879388,1.492,0.113,-0.000,255.21,253.41,1.280,0.050*6E [GPS=28879.393s r=1] STM32 UART5 CTRL: $CTRL,0.424,0.090,76.92,1456,1244,follow_path,28879393,1.492,0.113,-0.000,255.28,253.41,1.280,0.050*6C [GPS=28879.405s r=1] STM32 UART5 CTRL: $CTRL,0.424,0.092,76.92,1456,1245,follow_path,28879405,1.492,0.113,-0.000,255.35,253.41,1.280,0.050*6B [GPS=28879.417s r=1] STM32 UART5 CTRL: $CTRL,0.423,0.093,76.92,1455,1245,follow_path,28879417,1.492,0.113,-0.000,255.41,253.41,1.280,0.050*6E [GPS=28879.441s r=1] STM32 UART5 CTRL: $CTRL,0.422,0.096,76.92,1453,1245,follow_path,28879441,1.492,0.113,-0.000,255.48,253.41,1.280,0.050*66 [GPS=28879.453s r=1] STM32 UART5 CTRL: $CTRL,0.421,0.099,76.92,1452,1246,follow_path,28879453,1.492,0.113,-0.000,255.56,253.41,1.280,0.050*64 [GPS=28879.453s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.179,76.92,1589,1242,follow_path,28879453,1.451,0.102,-0.000,254.53,253.09,1.280,0.050*42 [GPS=28879.471s r=1] STM32 UART5 CTRL: $CTRL,0.429,0.080,76.92,1461,1242,follow_path,28879471,1.451,0.102,-0.000,254.61,253.09,1.280,0.050*66 [GPS=28879.483s r=1] STM32 UART5 CTRL: $CTRL,0.428,0.077,76.92,1463,1242,follow_path,28879483,1.451,0.102,-0.000,254.67,253.09,1.280,0.050*66 [GPS=28879.506s r=1] STM32 UART5 CTRL: $CTRL,0.428,0.079,76.92,1462,1243,follow_path,28879506,1.451,0.102,-0.000,254.73,253.09,1.280,0.050*61 [GPS=28879.518s r=1] STM32 UART5 CTRL: $CTRL,0.427,0.080,76.92,1461,1243,follow_path,28879518,1.451,0.102,-0.000,254.79,253.09,1.280,0.050*6E [GPS=28879.530s r=1] STM32 UART5 CTRL: $CTRL,0.426,0.083,76.92,1460,1243,follow_path,28879530,1.451,0.102,-0.000,254.85,253.09,1.280,0.050*64 [GPS=28879.536s r=1] STM32 UART5 CTRL: $CTRL,0.426,0.084,76.92,1459,1244,follow_path,28879536,1.451,0.102,-0.000,254.91,253.09,1.280,0.050*6D [GPS=28879.548s r=1] STM32 UART5 CTRL: $CTRL,0.425,0.087,76.92,1458,1244,follow_path,28879548,1.451,0.102,-0.000,254.97,253.09,1.280,0.050*63 [GPS=28879.560s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.140,76.92,1570,1240,follow_path,28879560,1.410,0.090,-0.000,254.05,252.74,1.280,0.050*48 [GPS=28879.584s r=1] STM32 UART5 CTRL: $CTRL,0.431,0.065,76.92,1468,1241,follow_path,28879584,1.410,0.090,-0.000,254.10,252.74,1.280,0.050*67 [GPS=28879.596s r=1] STM32 UART5 CTRL: $CTRL,0.431,0.066,76.92,1468,1241,follow_path,28879596,1.410,0.090,-0.000,254.15,252.74,1.280,0.050*62 [GPS=28879.602s r=1] STM32 UART5 CTRL: $CTRL,0.430,0.067,76.92,1467,1241,follow_path,28879602,1.410,0.090,-0.000,254.20,252.74,1.280,0.050*65 [GPS=28879.614s r=1] STM32 UART5 CTRL: $CTRL,0.430,0.069,76.92,1466,1241,follow_path,28879614,1.410,0.090,-0.000,254.25,252.74,1.280,0.050*68 [GPS=28879.625s r=1] STM32 UART5 CTRL: $CTRL,0.429,0.072,76.92,1465,1242,follow_path,28879625,1.410,0.090,-0.000,254.30,252.74,1.280,0.050*6C [GPS=28879.649s r=1] STM32 UART5 CTRL: $CTRL,0.429,0.074,76.92,1464,1242,follow_path,28879649,1.410,0.090,-0.000,254.36,252.74,1.280,0.050*67 [GPS=28879.649s r=1] STM32 UART5 CTRL: $CTRL,0.428,0.076,76.92,1463,1242,follow_path,28879649,1.410,0.090,-0.000,254.41,252.74,1.280,0.050*63 [GPS=28879.666s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879666,1.368,0.078,-0.000,253.63,170.21,3.490,-12.220*74 [GPS=28879.679s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879679,1.368,0.078,-0.000,253.69,170.21,3.490,-12.220*70 [GPS=28879.690s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879690,1.368,0.078,-0.000,253.77,170.21,3.490,-12.220*78 [GPS=28879.715s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879715,1.368,0.078,-0.000,253.90,170.21,3.490,-12.220*7D [GPS=28879.727s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879727,1.368,0.078,-0.000,254.06,170.21,3.490,-12.220*74 [GPS=28879.732s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879732,1.368,0.078,-0.000,254.23,170.21,3.490,-12.220*77 [GPS=28879.744s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879744,1.368,0.078,-0.000,254.43,170.21,3.490,-12.220*70 [GPS=28879.756s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879756,1.368,0.078,-0.000,254.66,170.21,3.490,-12.220*74 [GPS=28879.769s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879769,1.331,0.067,-0.000,252.81,170.04,3.490,-12.220*72 [GPS=28879.792s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879792,1.331,0.067,-0.000,253.13,170.04,3.490,-12.220*7C [GPS=28879.798s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879798,1.331,0.067,-0.000,253.46,170.04,3.490,-12.220*76 [GPS=28879.810s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879810,1.331,0.067,-0.000,253.81,170.04,3.490,-12.220*72 [GPS=28879.822s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879822,1.331,0.067,-0.000,254.20,170.04,3.490,-12.220*7F [GPS=28879.833s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879833,1.331,0.067,-0.000,254.62,170.04,3.490,-12.220*79 [GPS=28879.857s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879857,1.331,0.067,-0.000,255.09,170.04,3.490,-12.220*77 [GPS=28879.857s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879857,1.331,0.067,-0.000,255.57,170.04,3.490,-12.220*7C [GPS=28879.875s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.501,76.92,1257,1420,follow_path,28879875,1.309,0.060,-0.000,250.24,169.93,3.490,-12.220*79 [GPS=28879.887s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879887,1.309,0.060,-0.000,250.78,169.93,3.490,-12.220*73 [GPS=28879.899s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879899,1.309,0.060,-0.000,251.30,169.93,3.490,-12.220*71 [GPS=28879.911s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879911,1.309,0.060,-0.000,251.81,169.93,3.490,-12.220*7A [GPS=28879.929s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879929,1.309,0.060,-0.000,252.37,169.93,3.490,-12.220*7F [GPS=28879.941s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879941,1.309,0.060,-0.000,252.96,169.93,3.490,-12.220*7A [GPS=28879.953s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879953,1.309,0.060,-0.000,253.57,169.93,3.490,-12.220*75 [GPS=28879.953s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.224,76.92,1611,1420,follow_path,28879953,1.300,0.056,-0.000,246.38,169.89,3.490,-12.220*5A [GPS=28879.977s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879977,1.300,0.056,-0.000,246.99,169.89,3.490,-12.220*72 [GPS=28879.977s r=1] STM32 UART5 POSE: $POSE,1.300,0.056,-0.000,246.99,0.00,-21.42,3.490,-12.220,28879977*34 [GPS=28879.995s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28879995,1.300,0.056,-0.000,247.59,169.89,3.490,-12.220*73 [GPS=28880.007s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880007,1.300,0.056,-0.000,248.20,169.89,3.490,-12.220*76 [GPS=28880.019s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880019,1.300,0.056,-0.000,248.81,169.89,3.490,-12.220*72 [GPS=28880.031s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880031,1.300,0.056,-0.000,249.42,169.89,3.490,-12.220*76 [GPS=28880.043s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880043,1.300,0.056,-0.000,250.04,169.89,3.490,-12.220*79 [GPS=28880.055s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880055,1.300,0.056,-0.000,250.65,169.89,3.490,-12.220*79 [GPS=28880.061s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880061,1.293,0.052,-0.000,241.49,169.85,3.490,-12.220*55 [GPS=28880.084s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880084,1.293,0.052,-0.000,242.10,169.85,3.490,-12.220*77 [GPS=28880.096s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880096,1.293,0.052,-0.000,242.68,169.85,3.490,-12.220*7B [GPS=28880.108s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880108,1.293,0.052,-0.000,243.29,169.85,3.490,-12.220*79 [GPS=28880.114s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880114,1.293,0.052,-0.000,243.91,169.85,3.490,-12.220*77 [GPS=28880.138s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880138,1.293,0.052,-0.000,244.52,169.85,3.490,-12.220*71 [GPS=28880.150s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880150,1.293,0.052,-0.000,245.13,169.85,3.490,-12.220*7B [GPS=28880.162s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880162,1.293,0.052,-0.000,245.74,169.85,3.490,-12.220*7B [GPS=28880.174s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880174,1.286,0.048,-0.000,237.15,169.82,3.490,-12.220*50 [GPS=28880.180s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880180,1.286,0.048,-0.000,237.76,169.82,3.490,-12.220*78 [GPS=28880.192s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880192,1.286,0.048,-0.000,238.35,169.82,3.490,-12.220*73 [GPS=28880.216s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880216,1.286,0.048,-0.000,238.96,169.82,3.490,-12.220*75 [GPS=28880.228s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880228,1.286,0.048,-0.000,239.57,169.82,3.490,-12.220*74 [GPS=28880.240s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880240,1.286,0.048,-0.000,240.19,169.82,3.490,-12.220*7E [GPS=28880.246s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880246,1.286,0.048,-0.000,240.80,169.82,3.490,-12.220*78 [GPS=28880.258s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880258,1.286,0.048,-0.000,241.41,169.82,3.490,-12.220*7B [GPS=28880.282s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880282,1.280,0.043,-0.000,232.50,169.78,3.490,-12.220*56 [GPS=28880.294s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880294,1.280,0.043,-0.000,233.11,169.78,3.490,-12.220*73 [GPS=28880.306s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880306,1.280,0.043,-0.000,233.69,169.78,3.490,-12.220*76 [GPS=28880.312s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880312,1.280,0.043,-0.000,234.29,169.78,3.490,-12.220*70 [GPS=28880.324s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880324,1.280,0.043,-0.000,234.90,169.78,3.490,-12.220*77 [GPS=28880.336s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880336,1.280,0.043,-0.000,235.51,169.78,3.490,-12.220*78 [GPS=28880.360s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880360,1.280,0.043,-0.000,236.12,169.78,3.490,-12.220*7F [GPS=28880.360s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880360,1.280,0.043,-0.000,236.73,169.78,3.490,-12.220*78 [GPS=28880.360s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.002,66.95,28880360*38 [GPS=28880.384s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880384,1.273,0.038,-0.000,227.85,169.75,3.490,-12.220*50 [GPS=28880.390s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880390,1.273,0.038,-0.000,228.46,169.75,3.490,-12.220*73 [GPS=28880.402s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880402,1.273,0.038,-0.000,229.06,169.75,3.490,-12.220*7A [GPS=28880.425s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880425,1.273,0.038,-0.000,229.67,169.75,3.490,-12.220*78 [GPS=28880.437s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880437,1.273,0.038,-0.000,230.28,169.75,3.490,-12.220*78 [GPS=28880.443s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880443,1.273,0.038,-0.000,230.89,169.75,3.490,-12.220*70 [GPS=28880.455s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880455,1.273,0.038,-0.000,231.50,169.75,3.490,-12.220*72 [GPS=28880.467s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880467,1.268,0.032,-0.000,223.24,169.72,3.490,-12.220*52 [GPS=28880.490s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880490,1.268,0.032,-0.000,223.84,169.72,3.490,-12.220*76 [GPS=28880.502s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880502,1.268,0.032,-0.000,224.44,169.72,3.490,-12.220*77 [GPS=28880.513s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880513,1.268,0.032,-0.000,225.05,169.72,3.490,-12.220*73 [GPS=28880.519s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880519,1.268,0.032,-0.000,225.66,169.72,3.490,-12.220*7C [GPS=28880.531s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880531,1.268,0.032,-0.000,226.27,169.72,3.490,-12.220*70 [GPS=28880.543s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880543,1.268,0.032,-0.000,226.88,169.72,3.490,-12.220*70 [GPS=28880.555s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880555,1.268,0.032,-0.000,227.49,169.72,3.490,-12.220*7B [GPS=28880.579s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880579,1.262,0.026,-0.000,218.69,169.69,3.490,-12.220*58 [GPS=28880.591s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880591,1.262,0.026,-0.000,219.30,169.69,3.490,-12.220*75 [GPS=28880.597s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880597,1.262,0.026,-0.000,219.90,169.69,3.490,-12.220*79 [GPS=28880.609s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880609,1.262,0.026,-0.000,220.50,169.69,3.490,-12.220*7B [GPS=28880.633s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880633,1.262,0.026,-0.000,221.11,169.69,3.490,-12.220*76 [GPS=28880.645s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880645,1.262,0.026,-0.000,221.72,169.69,3.490,-12.220*72 [GPS=28880.657s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880657,1.262,0.026,-0.000,222.33,169.69,3.490,-12.220*77 [GPS=28880.663s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880663,1.262,0.026,-0.000,222.94,169.69,3.490,-12.220*7D [GPS=28880.675s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880675,1.258,0.020,-0.000,214.04,169.66,3.490,-12.220*50 [GPS=28880.687s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880687,1.258,0.020,-0.000,214.66,169.66,3.490,-12.220*7F [GPS=28880.711s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880711,1.258,0.020,-0.000,215.25,169.66,3.490,-12.220*77 [GPS=28880.717s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880717,1.258,0.020,-0.000,215.86,169.66,3.490,-12.220*78 [GPS=28880.729s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880729,1.258,0.020,-0.000,216.47,169.66,3.490,-12.220*7B [GPS=28880.741s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880741,1.258,0.020,-0.000,217.09,169.66,3.490,-12.220*7E [GPS=28880.753s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880753,1.258,0.020,-0.000,217.70,169.66,3.490,-12.220*73 [GPS=28880.765s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880765,1.254,0.013,-0.000,209.39,169.64,3.490,-12.220*5C [GPS=28880.789s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880789,1.254,0.013,-0.000,209.99,169.64,3.490,-12.220*72 [GPS=28880.795s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880795,1.254,0.013,-0.000,210.57,169.64,3.490,-12.220*75 [GPS=28880.807s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880807,1.254,0.013,-0.000,211.18,169.64,3.490,-12.220*7B [GPS=28880.819s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880819,1.254,0.013,-0.000,211.79,169.64,3.490,-12.220*73 [GPS=28880.831s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880831,1.254,0.013,-0.000,212.40,169.64,3.490,-12.220*70 [GPS=28880.855s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880855,1.254,0.013,-0.000,213.01,169.64,3.490,-12.220*76 [GPS=28880.861s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880861,1.254,0.013,-0.000,213.62,169.64,3.490,-12.220*74 [GPS=28880.861s r=1] STM32 UART5 CTRL: $CTRL,0.080,-0.800,76.92,1898,1420,follow_path,28880861,1.250,0.006,-0.000,205.02,169.62,3.490,-12.220*55 [GPS=28880.885s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880885,1.250,0.006,-0.000,205.63,169.62,3.490,-12.220*7E [GPS=28880.897s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880897,1.250,0.006,-0.000,206.21,169.62,3.490,-12.220*78 [GPS=28880.909s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880909,1.250,0.006,-0.000,206.82,169.62,3.490,-12.220*77 [GPS=28880.927s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880927,1.250,0.006,-0.000,207.43,169.62,3.490,-12.220*77 [GPS=28880.939s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880939,1.250,0.006,-0.000,208.04,169.62,3.490,-12.220*74 [GPS=28880.951s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880951,1.250,0.006,-0.000,208.65,169.62,3.490,-12.220*7D [GPS=28880.963s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28880963,1.250,0.006,-0.000,209.27,169.62,3.490,-12.220*7B [GPS=28880.963s r=1] STM32 UART5 CTRL: $CTRL,0.111,-0.800,76.92,1898,1404,follow_path,28880963,1.247,-0.002,-0.000,200.37,169.60,3.490,-12.220*77 [GPS=28880.963s r=1] STM32 UART5 POSE: $POSE,1.247,-0.002,-0.000,200.37,0.00,-21.42,3.490,-12.220,28880963*1F [GPS=28880.987s r=1] STM32 UART5 CTRL: $CTRL,0.105,0.800,76.92,1112,1407,follow_path,28880987,1.247,-0.002,-0.000,200.98,169.60,3.490,-12.220*58 [GPS=28881.005s r=1] STM32 UART5 CTRL: $CTRL,0.099,0.800,76.92,1112,1410,follow_path,28881005,1.247,-0.002,-0.000,201.55,169.60,3.490,-12.220*58 [GPS=28881.017s r=1] STM32 UART5 CTRL: $CTRL,0.093,0.800,76.92,1112,1413,follow_path,28881017,1.247,-0.002,-0.000,202.14,169.60,3.490,-12.220*54 [GPS=28881.028s r=1] STM32 UART5 CTRL: $CTRL,0.086,0.800,76.92,1112,1417,follow_path,28881028,1.247,-0.002,-0.000,202.75,169.60,3.490,-12.220*5F [GPS=28881.040s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28881040,1.247,-0.002,-0.000,203.36,169.60,3.490,-12.220*55 [GPS=28881.046s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28881046,1.247,-0.002,-0.000,203.97,169.60,3.490,-12.220*58 [GPS=28881.058s r=1] STM32 UART5 CTRL: $CTRL,0.080,0.800,76.92,1112,1420,follow_path,28881058,1.247,-0.002,-0.000,204.59,169.60,3.490,-12.220*52 [GPS=28881.082s r=1] STM32 UART5 CTRL: $CTRL,0.157,-0.800,76.92,1898,1380,follow_path,28881082,1.244,-0.011,-0.000,195.77,169.58,3.490,-12.220*78 [GPS=28881.094s r=1] STM32 UART5 CTRL: $CTRL,0.151,0.800,76.92,1112,1384,follow_path,28881094,1.244,-0.011,-0.000,196.38,169.58,3.490,-12.220*53 [GPS=28881.106s r=1] STM32 UART5 CTRL: $CTRL,0.145,0.800,76.92,1112,1387,follow_path,28881106,1.244,-0.011,-0.000,196.96,169.58,3.490,-12.220*5B [GPS=28881.112s r=1] STM32 UART5 CTRL: $CTRL,0.139,0.800,76.92,1112,1390,follow_path,28881112,1.244,-0.011,-0.000,197.56,169.58,3.490,-12.220*5E [GPS=28881.136s r=1] STM32 UART5 CTRL: $CTRL,0.132,0.800,76.92,1112,1393,follow_path,28881136,1.244,-0.011,-0.000,198.17,169.58,3.490,-12.220*5A [GPS=28881.148s r=1] STM32 UART5 CTRL: $CTRL,0.126,0.800,76.92,1112,1397,follow_path,28881148,1.244,-0.011,-0.000,198.78,169.58,3.490,-12.220*5B [GPS=28881.160s r=1] STM32 UART5 CTRL: $CTRL,0.119,0.800,76.92,1112,1400,follow_path,28881160,1.244,-0.011,-0.000,199.39,169.58,3.490,-12.220*50 [GPS=28881.172s r=1] STM32 UART5 CTRL: $CTRL,0.113,0.800,76.92,1112,1403,follow_path,28881172,1.244,-0.011,-0.000,200.00,169.58,3.490,-12.220*53 [GPS=28881.184s r=1] STM32 UART5 CTRL: $CTRL,0.204,-0.800,76.92,1898,1357,follow_path,28881184,1.242,-0.022,-0.000,191.13,169.56,3.490,-12.220*7E [GPS=28881.190s r=1] STM32 UART5 CTRL: $CTRL,0.198,0.800,76.92,1112,1360,follow_path,28881190,1.242,-0.022,-0.000,191.74,169.56,3.490,-12.220*5E [GPS=28881.214s r=1] STM32 UART5 CTRL: $CTRL,0.191,0.800,76.92,1112,1363,follow_path,28881214,1.242,-0.022,-0.000,192.33,169.56,3.490,-12.220*5B [GPS=28881.226s r=1] STM32 UART5 CTRL: $CTRL,0.185,0.800,76.92,1112,1366,follow_path,28881226,1.242,-0.022,-0.000,192.95,169.56,3.490,-12.220*56 [GPS=28881.238s r=1] STM32 UART5 CTRL: $CTRL,0.179,0.800,76.92,1112,1370,follow_path,28881238,1.242,-0.022,-0.000,193.55,169.56,3.490,-12.220*50 [GPS=28881.244s r=1] STM32 UART5 CTRL: $CTRL,0.172,0.800,76.92,1112,1373,follow_path,28881244,1.242,-0.022,-0.000,194.16,169.56,3.490,-12.220*53 [GPS=28881.256s r=1] STM32 UART5 CTRL: $CTRL,0.166,0.800,76.92,1112,1376,follow_path,28881256,1.242,-0.022,-0.000,194.78,169.56,3.490,-12.220*58 [GPS=28881.268s r=1] STM32 UART5 CTRL: $CTRL,0.250,-0.800,76.92,1898,1333,follow_path,28881268,1.240,-0.037,-0.000,186.50,169.54,3.490,-12.220*79 [GPS=28881.292s r=1] STM32 UART5 CTRL: $CTRL,0.244,0.741,76.92,1141,1336,follow_path,28881292,1.240,-0.037,-0.000,187.09,169.54,3.490,-12.220*5B [GPS=28881.304s r=1] STM32 UART5 CTRL: $CTRL,0.238,0.747,76.92,1137,1339,follow_path,28881304,1.240,-0.037,-0.000,187.66,169.54,3.490,-12.220*5F [GPS=28881.316s r=1] STM32 UART5 CTRL: $CTRL,0.232,0.762,76.92,1130,1342,follow_path,28881316,1.240,-0.037,-0.000,188.23,169.54,3.490,-12.220*54 [GPS=28881.322s r=1] STM32 UART5 CTRL: $CTRL,0.226,0.781,76.92,1121,1345,follow_path,28881322,1.240,-0.037,-0.000,188.80,169.54,3.490,-12.220*55 [GPS=28881.334s r=1] STM32 UART5 CTRL: $CTRL,0.220,0.799,76.92,1112,1348,follow_path,28881334,1.240,-0.037,-0.000,189.38,169.54,3.490,-12.220*52 [GPS=28881.358s r=1] STM32 UART5 CTRL: $CTRL,0.214,0.800,76.92,1112,1352,follow_path,28881358,1.240,-0.037,-0.000,189.99,169.54,3.490,-12.220*50 [GPS=28881.370s r=1] STM32 UART5 CTRL: $CTRL,0.207,0.800,76.92,1112,1355,follow_path,28881370,1.240,-0.037,-0.000,190.60,169.54,3.490,-12.220*51 [GPS=28881.370s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.055,21.07,28881370*32 [GPS=28881.382s r=1] STM32 UART5 CTRL: $CTRL,0.295,-0.800,76.92,1898,1310,follow_path,28881382,1.238,-0.058,-0.000,181.98,169.51,3.490,-12.220*74 [GPS=28881.388s r=1] STM32 UART5 CTRL: $CTRL,0.289,0.625,76.92,1196,1313,follow_path,28881388,1.238,-0.058,-0.000,182.59,169.51,3.490,-12.220*5D [GPS=28881.400s r=1] STM32 UART5 CTRL: $CTRL,0.283,0.637,76.92,1191,1316,follow_path,28881400,1.238,-0.058,-0.000,183.19,169.51,3.490,-12.220*54 [GPS=28881.412s r=1] STM32 UART5 CTRL: $CTRL,0.277,0.643,76.92,1188,1319,follow_path,28881412,1.238,-0.058,-0.000,183.75,169.51,3.490,-12.220*52 [GPS=28881.436s r=1] STM32 UART5 CTRL: $CTRL,0.272,0.638,76.92,1190,1322,follow_path,28881436,1.238,-0.058,-0.000,184.26,169.51,3.490,-12.220*5D [GPS=28881.442s r=1] STM32 UART5 CTRL: $CTRL,0.266,0.648,76.92,1186,1325,follow_path,28881442,1.238,-0.058,-0.000,184.75,169.51,3.490,-12.220*5A [GPS=28881.454s r=1] STM32 UART5 CTRL: $CTRL,0.261,0.659,76.92,1180,1327,follow_path,28881454,1.238,-0.058,-0.000,185.24,169.51,3.490,-12.220*5B [GPS=28881.466s r=1] STM32 UART5 CTRL: $CTRL,0.256,0.676,76.92,1172,1330,follow_path,28881466,1.238,-0.058,-0.000,185.74,169.51,3.490,-12.220*5D [GPS=28881.478s r=1] STM32 UART5 CTRL: $CTRL,0.338,-0.800,76.92,1898,1288,follow_path,28881478,1.239,-0.083,-0.000,177.76,169.49,3.490,-12.220*77 [GPS=28881.502s r=1] STM32 UART5 CTRL: $CTRL,0.333,0.473,76.92,1270,1291,follow_path,28881502,1.239,-0.083,-0.000,178.26,169.49,3.490,-12.220*5B [GPS=28881.508s r=1] STM32 UART5 CTRL: $CTRL,0.327,0.481,76.92,1266,1294,follow_path,28881508,1.239,-0.083,-0.000,178.75,169.49,3.490,-12.220*5D [GPS=28881.520s r=1] STM32 UART5 CTRL: $CTRL,0.323,0.486,76.92,1264,1296,follow_path,28881520,1.239,-0.083,-0.000,179.21,169.49,3.490,-12.220*54 [GPS=28881.532s r=1] STM32 UART5 CTRL: $CTRL,0.318,0.488,76.92,1263,1298,follow_path,28881532,1.239,-0.083,-0.000,179.64,169.49,3.490,-12.220*59 [GPS=28881.544s r=1] STM32 UART5 CTRL: $CTRL,0.314,0.490,76.92,1262,1301,follow_path,28881544,1.239,-0.083,-0.000,180.04,169.49,3.490,-12.220*5D [GPS=28881.556s r=1] STM32 UART5 CTRL: $CTRL,0.310,0.492,76.92,1261,1303,follow_path,28881556,1.239,-0.083,-0.000,180.41,169.49,3.490,-12.220*58 [GPS=28881.568s r=1] STM32 UART5 CTRL: $CTRL,0.306,0.502,76.92,1256,1305,follow_path,28881568,1.239,-0.083,-0.000,180.79,169.49,3.490,-12.220*53 [GPS=28881.586s r=1] STM32 UART5 CTRL: $CTRL,0.371,-0.800,76.92,1898,1271,follow_path,28881586,1.241,-0.112,-0.000,174.47,169.48,3.490,-12.220*7A [GPS=28881.598s r=1] STM32 UART5 CTRL: $CTRL,0.367,0.342,76.92,1334,1273,follow_path,28881598,1.241,-0.112,-0.000,174.85,169.48,3.490,-12.220*53 [GPS=28881.610s r=1] STM32 UART5 CTRL: $CTRL,0.363,0.343,76.92,1333,1275,follow_path,28881610,1.241,-0.112,-0.000,175.21,169.48,3.490,-12.220*5B [GPS=28881.622s r=1] STM32 UART5 CTRL: $CTRL,0.360,0.343,76.92,1334,1277,follow_path,28881622,1.241,-0.112,-0.000,175.53,169.48,3.490,-12.220*59 [GPS=28881.639s r=1] STM32 UART5 CTRL: $CTRL,0.357,0.337,76.92,1336,1279,follow_path,28881639,1.241,-0.112,-0.000,175.82,169.48,3.490,-12.220*54 [GPS=28881.651s r=1] STM32 UART5 CTRL: $CTRL,0.354,0.337,76.92,1337,1280,follow_path,28881651,1.241,-0.112,-0.000,176.08,169.48,3.490,-12.220*5F [GPS=28881.663s r=1] STM32 UART5 CTRL: $CTRL,0.351,0.343,76.92,1334,1281,follow_path,28881663,1.241,-0.112,-0.000,176.34,169.48,3.490,-12.220*55 [GPS=28881.675s r=1] STM32 UART5 CTRL: $CTRL,0.349,0.350,76.92,1330,1283,follow_path,28881675,1.241,-0.112,-0.000,176.60,169.48,3.490,-12.220*5E [GPS=28881.687s r=1] STM32 UART5 CTRL: $CTRL,0.397,-0.800,76.92,1898,1258,follow_path,28881687,1.246,-0.146,-0.000,171.95,169.47,3.490,-12.220*78 [GPS=28881.699s r=1] STM32 UART5 CTRL: $CTRL,0.394,0.233,76.92,1387,1260,follow_path,28881699,1.246,-0.146,-0.000,172.22,169.47,3.490,-12.220*52 [GPS=28881.717s r=1] STM32 UART5 CTRL: $CTRL,0.391,0.229,76.92,1389,1261,follow_path,28881717,1.246,-0.146,-0.000,172.46,169.47,3.490,-12.220*56 [GPS=28881.729s r=1] STM32 UART5 CTRL: $CTRL,0.389,0.226,76.92,1390,1262,follow_path,28881729,1.246,-0.146,-0.000,172.66,169.47,3.490,-12.220*54 [GPS=28881.741s r=1] STM32 UART5 CTRL: $CTRL,0.387,0.222,76.92,1392,1263,follow_path,28881741,1.246,-0.146,-0.000,172.84,169.47,3.490,-12.220*5F [GPS=28881.753s r=1] STM32 UART5 CTRL: $CTRL,0.385,0.224,76.92,1391,1264,follow_path,28881753,1.246,-0.146,-0.000,173.02,169.47,3.490,-12.220*53 [GPS=28881.764s r=1] STM32 UART5 CTRL: $CTRL,0.384,0.228,76.92,1389,1265,follow_path,28881764,1.246,-0.146,-0.000,173.19,169.47,3.490,-12.220*58 [GPS=28881.770s r=1] STM32 UART5 CTRL: $CTRL,0.382,0.232,76.92,1387,1266,follow_path,28881770,1.246,-0.146,-0.000,173.35,169.47,3.490,-12.220*53 [GPS=28881.794s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.800,76.92,1898,1249,follow_path,28881794,1.252,-0.183,-0.000,170.23,169.47,3.490,-12.220*77 [GPS=28881.806s r=1] STM32 UART5 CTRL: $CTRL,0.412,0.154,76.92,1425,1250,follow_path,28881806,1.252,-0.183,-0.000,170.41,169.47,3.490,-12.220*56 [GPS=28881.818s r=1] STM32 UART5 CTRL: $CTRL,0.411,0.148,76.92,1428,1251,follow_path,28881818,1.252,-0.183,-0.000,170.56,169.47,3.490,-12.220*5D [GPS=28881.830s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.143,76.92,1431,1252,follow_path,28881830,1.252,-0.183,-0.000,170.68,169.47,3.490,-12.220*5B [GPS=28881.836s r=1] STM32 UART5 CTRL: $CTRL,0.408,0.143,76.92,1431,1252,follow_path,28881836,1.252,-0.183,-0.000,170.79,169.47,3.490,-12.220*54 [GPS=28881.860s r=1] STM32 UART5 CTRL: $CTRL,0.407,0.144,76.92,1430,1253,follow_path,28881860,1.252,-0.183,-0.000,170.90,169.47,3.490,-12.220*58 [GPS=28881.872s r=1] STM32 UART5 CTRL: $CTRL,0.406,0.147,76.92,1429,1253,follow_path,28881872,1.252,-0.183,-0.000,171.01,169.47,3.490,-12.220*58 [GPS=28881.884s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.558,76.92,1777,1247,follow_path,28881884,1.259,-0.223,-0.000,169.12,169.47,3.490,-12.220*7C [GPS=28881.896s r=1] STM32 UART5 CTRL: $CTRL,0.420,0.100,76.92,1452,1246,follow_path,28881896,1.259,-0.223,-0.000,169.23,169.47,3.490,-12.220*56 [GPS=28881.902s r=1] STM32 UART5 CTRL: $CTRL,0.421,0.097,76.92,1453,1246,follow_path,28881902,1.259,-0.223,-0.000,169.33,169.47,3.490,-12.220*54 [GPS=28881.926s r=1] STM32 UART5 CTRL: $CTRL,0.422,0.093,76.92,1455,1245,follow_path,28881926,1.259,-0.223,-0.000,169.41,169.47,3.490,-12.220*55 [GPS=28881.938s r=1] STM32 UART5 CTRL: $CTRL,0.422,0.093,76.92,1455,1245,follow_path,28881938,1.259,-0.223,-0.000,169.48,169.47,3.490,-12.220*53 [GPS=28881.950s r=1] STM32 UART5 CTRL: $CTRL,0.422,0.094,76.92,1454,1246,follow_path,28881950,1.259,-0.223,-0.000,169.55,169.47,3.490,-12.220*54 [GPS=28881.962s r=1] STM32 UART5 CTRL: $CTRL,0.421,0.097,76.92,1453,1246,follow_path,28881962,1.259,-0.223,-0.000,169.62,169.47,3.490,-12.220*56 [GPS=28881.974s r=1] STM32 UART5 CTRL: $CTRL,0.420,0.099,76.92,1452,1246,follow_path,28881974,1.259,-0.223,-0.000,169.70,169.47,3.490,-12.220*5C [GPS=28881.974s r=1] STM32 UART5 POSE: $POSE,1.259,-0.223,-0.000,169.70,-56.29,-19.62,3.490,-12.220,28881974*05 [GPS=28881.980s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.367,76.92,1682,1250,follow_path,28881980,1.268,-0.265,-0.000,168.46,169.47,3.490,-12.220*75 [GPS=28882.004s r=1] STM32 UART5 CTRL: $CTRL,0.413,0.061,76.92,1470,1250,follow_path,28882004,1.268,-0.265,-0.000,168.52,169.47,3.490,-12.220*50 [GPS=28882.016s r=1] STM32 UART5 CTRL: $CTRL,0.413,0.053,76.92,1474,1250,follow_path,28882016,1.268,-0.265,-0.000,168.55,169.47,3.490,-12.220*51 [GPS=28882.027s r=1] STM32 UART5 CTRL: $CTRL,0.414,0.059,76.92,1471,1250,follow_path,28882027,1.268,-0.265,-0.000,168.60,169.47,3.490,-12.220*5D [GPS=28882.033s r=1] STM32 UART5 CTRL: $CTRL,0.414,0.058,76.92,1472,1249,follow_path,28882033,1.268,-0.265,-0.000,168.64,169.47,3.490,-12.220*56 [GPS=28882.045s r=1] STM32 UART5 CTRL: $CTRL,0.415,0.061,76.92,1470,1249,follow_path,28882045,1.268,-0.265,-0.000,168.68,169.47,3.490,-12.220*52 [GPS=28882.069s r=1] STM32 UART5 CTRL: $CTRL,0.415,0.063,76.92,1469,1249,follow_path,28882069,1.268,-0.265,-0.000,168.73,169.47,3.490,-12.220*5C [GPS=28882.069s r=1] STM32 UART5 CTRL: $CTRL,0.416,0.065,76.92,1469,1249,follow_path,28882069,1.268,-0.265,-0.000,168.78,169.47,3.490,-12.220*52 [GPS=28882.093s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.214,76.92,1607,1252,follow_path,28882093,1.276,-0.306,-0.000,168.05,169.47,3.490,-12.220*70 [GPS=28882.105s r=1] STM32 UART5 CTRL: $CTRL,0.409,0.044,76.92,1479,1252,follow_path,28882105,1.276,-0.306,-0.000,168.09,169.47,3.490,-12.220*52 [GPS=28882.111s r=1] STM32 UART5 CTRL: $CTRL,0.409,0.040,76.92,1480,1252,follow_path,28882111,1.276,-0.306,-0.000,168.13,169.47,3.490,-12.220*5E [GPS=28882.123s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.042,76.92,1480,1252,follow_path,28882123,1.276,-0.306,-0.000,168.16,169.47,3.490,-12.220*50 [GPS=28882.147s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.042,76.92,1479,1252,follow_path,28882147,1.276,-0.306,-0.000,168.20,169.47,3.490,-12.220*51 [GPS=28882.159s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.043,76.92,1479,1251,follow_path,28882159,1.276,-0.306,-0.000,168.23,169.47,3.490,-12.220*5F [GPS=28882.165s r=1] STM32 UART5 CTRL: $CTRL,0.411,0.044,76.92,1479,1251,follow_path,28882165,1.276,-0.306,-0.000,168.26,169.47,3.490,-12.220*53 [GPS=28882.177s r=1] STM32 UART5 CTRL: $CTRL,0.411,0.045,76.92,1478,1251,follow_path,28882177,1.276,-0.306,-0.000,168.29,169.47,3.490,-12.220*5F [GPS=28882.189s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.159,76.92,1579,1254,follow_path,28882189,1.285,-0.347,-0.000,167.76,169.48,3.490,-12.220*7F [GPS=28882.212s r=1] STM32 UART5 CTRL: $CTRL,0.406,0.024,76.92,1488,1254,follow_path,28882212,1.285,-0.347,-0.000,167.78,169.48,3.490,-12.220*59 [GPS=28882.224s r=1] STM32 UART5 CTRL: $CTRL,0.406,0.025,76.92,1488,1253,follow_path,28882224,1.285,-0.347,-0.000,167.80,169.48,3.490,-12.220*5D [GPS=28882.236s r=1] STM32 UART5 CTRL: $CTRL,0.406,0.025,76.92,1488,1253,follow_path,28882236,1.285,-0.347,-0.000,167.82,169.48,3.490,-12.220*5C [GPS=28882.242s r=1] STM32 UART5 CTRL: $CTRL,0.407,0.026,76.92,1487,1253,follow_path,28882242,1.285,-0.347,-0.000,167.84,169.48,3.490,-12.220*54 [GPS=28882.254s r=1] STM32 UART5 CTRL: $CTRL,0.407,0.027,76.92,1487,1253,follow_path,28882254,1.285,-0.347,-0.000,167.86,169.48,3.490,-12.220*50 [GPS=28882.266s r=1] STM32 UART5 CTRL: $CTRL,0.407,0.027,76.92,1487,1253,follow_path,28882266,1.285,-0.347,-0.000,167.88,169.48,3.490,-12.220*5F [GPS=28882.278s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.088,76.92,1544,1254,follow_path,28882278,1.294,-0.387,-0.000,167.58,169.49,3.490,-12.220*73 [GPS=28882.296s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.019,76.92,1491,1254,follow_path,28882296,1.294,-0.387,-0.000,167.61,169.49,3.490,-12.220*55 [GPS=28882.308s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.008,76.92,1496,1254,follow_path,28882308,1.294,-0.387,-0.000,167.60,169.49,3.490,-12.220*55 [GPS=28882.320s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.008,76.92,1496,1254,follow_path,28882320,1.294,-0.387,-0.000,167.59,169.49,3.490,-12.220*55 [GPS=28882.332s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.014,76.92,1493,1254,follow_path,28882332,1.294,-0.387,-0.000,167.60,169.49,3.490,-12.220*54 [GPS=28882.356s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.016,76.92,1492,1254,follow_path,28882356,1.294,-0.387,-0.000,167.61,169.49,3.490,-12.220*54 [GPS=28882.368s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.015,76.92,1493,1254,follow_path,28882368,1.294,-0.387,-0.000,167.62,169.49,3.490,-12.220*58 [GPS=28882.368s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.064,-1.87,28882368*2D [GPS=28882.374s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.016,76.92,1492,1254,follow_path,28882374,1.294,-0.387,-0.000,167.63,169.49,3.490,-12.220*56 [GPS=28882.386s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.026,76.92,1513,1254,follow_path,28882386,1.302,-0.425,-0.000,167.53,169.49,3.490,-12.220*7F [GPS=28882.398s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.012,76.92,1494,1254,follow_path,28882398,1.302,-0.425,-0.000,167.55,169.49,3.490,-12.220*52 [GPS=28882.410s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.007,76.92,1496,1254,follow_path,28882410,1.302,-0.425,-0.000,167.54,169.49,3.490,-12.220*52 [GPS=28882.433s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.009,76.92,1495,1254,follow_path,28882433,1.302,-0.425,-0.000,167.55,169.49,3.490,-12.220*5F [GPS=28882.445s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.011,76.92,1495,1254,follow_path,28882445,1.302,-0.425,-0.000,167.56,169.49,3.490,-12.220*54 [GPS=28882.451s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.011,76.92,1495,1254,follow_path,28882451,1.302,-0.425,-0.000,167.56,169.49,3.490,-12.220*51 [GPS=28882.463s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.012,76.92,1494,1254,follow_path,28882463,1.302,-0.425,-0.000,167.57,169.49,3.490,-12.220*53 [GPS=28882.475s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.011,76.92,1495,1254,follow_path,28882475,1.302,-0.425,-0.000,167.58,169.49,3.490,-12.220*59 [GPS=28882.499s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.029,76.92,1514,1254,follow_path,28882499,1.311,-0.465,-0.000,167.48,169.50,3.490,-12.220*7A [GPS=28882.511s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.004,76.92,1498,1254,follow_path,28882511,1.311,-0.465,-0.000,167.48,169.50,3.490,-12.220*5C [GPS=28882.517s r=1] STM32 UART5 CTRL: $CTRL,0.404,-0.003,76.92,1501,1254,follow_path,28882517,1.311,-0.465,-0.000,167.46,169.50,3.490,-12.220*7E [GPS=28882.529s r=1] STM32 UART5 CTRL: $CTRL,0.404,0.005,76.92,1498,1254,follow_path,28882529,1.311,-0.465,-0.000,167.46,169.50,3.490,-12.220*59 [GPS=28882.541s r=1] STM32 UART5 CTRL: $CTRL,0.404,0.004,76.92,1498,1254,follow_path,28882541,1.311,-0.465,-0.000,167.46,169.50,3.490,-12.220*56 [GPS=28882.565s r=1] STM32 UART5 CTRL: $CTRL,0.404,0.005,76.92,1498,1254,follow_path,28882565,1.311,-0.465,-0.000,167.47,169.50,3.490,-12.220*50 [GPS=28882.571s r=1] STM32 UART5 CTRL: $CTRL,0.404,0.005,76.92,1498,1254,follow_path,28882571,1.311,-0.465,-0.000,167.47,169.50,3.490,-12.220*55 [GPS=28882.571s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.001,76.92,1501,1254,follow_path,28882571,1.320,-0.505,-0.000,167.47,169.51,3.490,-12.220*78 [GPS=28882.595s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.005,76.92,1498,1254,follow_path,28882595,1.320,-0.505,-0.000,167.47,169.51,3.490,-12.220*5A [GPS=28882.607s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.002,76.92,1499,1254,follow_path,28882607,1.320,-0.505,-0.000,167.47,169.51,3.490,-12.220*54 [GPS=28882.619s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.004,76.92,1498,1254,follow_path,28882619,1.320,-0.505,-0.000,167.48,169.51,3.490,-12.220*53 [GPS=28882.643s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.003,76.92,1499,1254,follow_path,28882643,1.320,-0.505,-0.000,167.48,169.51,3.490,-12.220*5A [GPS=28882.649s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.004,76.92,1498,1254,follow_path,28882649,1.320,-0.505,-0.000,167.48,169.51,3.490,-12.220*56 [GPS=28882.661s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.003,76.92,1499,1254,follow_path,28882661,1.320,-0.505,-0.000,167.48,169.51,3.490,-12.220*5A [GPS=28882.673s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.003,76.92,1498,1254,follow_path,28882673,1.320,-0.505,-0.000,167.49,169.51,3.490,-12.220*59 [GPS=28882.685s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.003,76.92,1498,1254,follow_path,28882685,1.320,-0.505,-0.000,167.49,169.51,3.490,-12.220*50 [GPS=28882.697s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.016,76.92,1508,1254,follow_path,28882697,1.329,-0.545,-0.000,167.45,169.51,3.490,-12.220*73 [GPS=28882.715s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.000,76.92,1510,1254,follow_path,28882715,1.329,-0.545,-0.000,167.45,169.51,3.490,-12.220*5B [GPS=28882.727s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.005,76.92,1503,1254,follow_path,28882727,1.329,-0.545,-0.000,167.44,169.51,3.490,-12.220*71 [GPS=28882.739s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.000,76.92,1510,1254,follow_path,28882739,1.329,-0.545,-0.000,167.44,169.51,3.490,-12.220*54 [GPS=28882.751s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.001,76.92,1501,1254,follow_path,28882751,1.329,-0.545,-0.000,167.44,169.51,3.490,-12.220*76 [GPS=28882.763s r=1] STM32 UART5 CTRL: $CTRL,0.405,-0.001,76.92,1510,1254,follow_path,28882763,1.329,-0.545,-0.000,167.44,169.51,3.490,-12.220*77 [GPS=28882.769s r=1] STM32 UART5 CTRL: $CTRL,0.405,0.000,76.92,1510,1254,follow_path,28882769,1.329,-0.545,-0.000,167.44,169.51,3.490,-12.220*51 [GPS=28882.793s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.000,76.92,1510,1254,follow_path,28882793,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*77 [GPS=28882.805s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.002,76.92,1501,1254,follow_path,28882805,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*75 [GPS=28882.817s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.002,76.92,1501,1254,follow_path,28882817,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*76 [GPS=28882.829s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.003,76.92,1501,1254,follow_path,28882829,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*7A [GPS=28882.840s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.002,76.92,1501,1254,follow_path,28882840,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*74 [GPS=28882.858s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.003,76.92,1501,1254,follow_path,28882858,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*7C [GPS=28882.870s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.002,76.92,1501,1254,follow_path,28882870,1.338,-0.586,-0.000,167.45,169.52,3.490,-12.220*77 [GPS=28882.882s r=1] STM32 UART5 CTRL: $CTRL,0.406,-0.003,76.92,1502,1254,follow_path,28882882,1.338,-0.586,-0.000,167.44,169.52,3.490,-12.220*79 [GPS=28882.893s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.000,76.92,1510,1253,follow_path,28882893,1.347,-0.626,-0.000,167.46,169.53,3.490,-12.220*7D [GPS=28882.905s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.004,76.92,1502,1253,follow_path,28882905,1.347,-0.626,-0.000,167.46,169.53,3.490,-12.220*74 [GPS=28882.918s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.004,76.92,1502,1253,follow_path,28882918,1.347,-0.626,-0.000,167.46,169.53,3.490,-12.220*78 [GPS=28882.935s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.005,76.92,1502,1253,follow_path,28882935,1.347,-0.626,-0.000,167.46,169.53,3.490,-12.220*76 [GPS=28882.947s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.005,76.92,1502,1253,follow_path,28882947,1.347,-0.626,-0.000,167.46,169.53,3.490,-12.220*73 [GPS=28882.959s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.005,76.92,1503,1253,follow_path,28882959,1.347,-0.626,-0.000,167.45,169.53,3.490,-12.220*7E [GPS=28882.971s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.006,76.92,1503,1253,follow_path,28882971,1.347,-0.626,-0.000,167.45,169.53,3.490,-12.220*77 [GPS=28882.971s r=1] STM32 UART5 POSE: $POSE,1.347,-0.626,-0.000,167.45,0.00,0.27,3.490,-12.220,28882971*05 [GPS=28882.977s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.004,76.92,1502,1253,follow_path,28882977,1.347,-0.626,-0.000,167.44,169.53,3.490,-12.220*73 [GPS=28883.001s r=1] STM32 UART5 CTRL: $CTRL,0.408,0.005,76.92,1498,1253,follow_path,28883001,1.356,-0.666,-0.000,167.48,169.53,3.490,-12.220*53 [GPS=28883.013s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.006,76.92,1503,1253,follow_path,28883013,1.356,-0.666,-0.000,167.48,169.53,3.490,-12.220*7D [GPS=28883.025s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.003,76.92,1501,1253,follow_path,28883025,1.356,-0.666,-0.000,167.49,169.53,3.490,-12.220*7E [GPS=28883.036s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.007,76.92,1503,1253,follow_path,28883036,1.356,-0.666,-0.000,167.48,169.53,3.490,-12.220*7B [GPS=28883.048s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.006,76.92,1503,1253,follow_path,28883048,1.356,-0.666,-0.000,167.48,169.53,3.490,-12.220*73 [GPS=28883.066s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.006,76.92,1503,1253,follow_path,28883066,1.356,-0.666,-0.000,167.47,169.53,3.490,-12.220*7F [GPS=28883.078s r=1] STM32 UART5 CTRL: $CTRL,0.407,-0.007,76.92,1503,1253,follow_path,28883078,1.356,-0.666,-0.000,167.47,169.53,3.490,-12.220*71 [GPS=28883.078s r=1] STM32 UART5 CTRL: $CTRL,0.408,0.003,76.92,1498,1252,follow_path,28883078,1.365,-0.706,-0.000,167.51,169.54,3.490,-12.220*52 [GPS=28883.102s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.008,76.92,1504,1252,follow_path,28883102,1.365,-0.706,-0.000,167.50,169.54,3.490,-12.220*7D [GPS=28883.114s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.006,76.92,1503,1252,follow_path,28883114,1.365,-0.706,-0.000,167.50,169.54,3.490,-12.220*73 [GPS=28883.132s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.008,76.92,1504,1252,follow_path,28883132,1.365,-0.706,-0.000,167.50,169.54,3.490,-12.220*7E [GPS=28883.143s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.008,76.92,1504,1252,follow_path,28883143,1.365,-0.706,-0.000,167.49,169.54,3.490,-12.220*70 [GPS=28883.155s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.009,76.92,1504,1252,follow_path,28883155,1.365,-0.706,-0.000,167.49,169.54,3.490,-12.220*76 [GPS=28883.167s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.010,76.92,1505,1253,follow_path,28883167,1.365,-0.706,-0.000,167.48,169.54,3.490,-12.220*7E [GPS=28883.173s r=1] STM32 UART5 CTRL: $CTRL,0.408,-0.009,76.92,1505,1253,follow_path,28883173,1.365,-0.706,-0.000,167.47,169.54,3.490,-12.220*7C [GPS=28883.185s r=1] STM32 UART5 CTRL: $CTRL,0.409,0.013,76.92,1494,1252,follow_path,28883185,1.373,-0.746,-0.000,167.54,169.55,3.490,-12.220*5A [GPS=28883.208s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.010,76.92,1505,1252,follow_path,28883208,1.373,-0.746,-0.000,167.53,169.55,3.490,-12.220*7C [GPS=28883.220s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.003,76.92,1502,1252,follow_path,28883220,1.373,-0.746,-0.000,167.54,169.55,3.490,-12.220*74 [GPS=28883.232s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.010,76.92,1505,1252,follow_path,28883232,1.373,-0.746,-0.000,167.53,169.55,3.490,-12.220*75 [GPS=28883.238s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.008,76.92,1504,1252,follow_path,28883238,1.373,-0.746,-0.000,167.53,169.55,3.490,-12.220*77 [GPS=28883.250s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.011,76.92,1505,1252,follow_path,28883250,1.373,-0.746,-0.000,167.52,169.55,3.490,-12.220*71 [GPS=28883.273s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.009,76.92,1505,1252,follow_path,28883273,1.373,-0.746,-0.000,167.52,169.55,3.490,-12.220*79 [GPS=28883.285s r=1] STM32 UART5 CTRL: $CTRL,0.409,-0.011,76.92,1505,1252,follow_path,28883285,1.373,-0.746,-0.000,167.51,169.55,3.490,-12.220*7A [GPS=28883.297s r=1] STM32 UART5 CTRL: $CTRL,0.410,0.011,76.92,1494,1251,follow_path,28883297,1.382,-0.786,-0.000,167.57,169.56,3.490,-12.220*51 [GPS=28883.303s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.011,76.92,1506,1251,follow_path,28883303,1.382,-0.786,-0.000,167.56,169.56,3.490,-12.220*7B [GPS=28883.315s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.006,76.92,1503,1251,follow_path,28883315,1.382,-0.786,-0.000,167.57,169.56,3.490,-12.220*7E [GPS=28883.339s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.009,76.92,1505,1251,follow_path,28883339,1.382,-0.786,-0.000,167.57,169.56,3.490,-12.220*79 [GPS=28883.351s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.010,76.92,1505,1251,follow_path,28883351,1.382,-0.786,-0.000,167.56,169.56,3.490,-12.220*7E [GPS=28883.363s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.010,76.92,1505,1252,follow_path,28883363,1.382,-0.786,-0.000,167.55,169.56,3.490,-12.220*7F [GPS=28883.363s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.048,-2.00,28883363*25 [GPS=28883.369s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.011,76.92,1505,1252,follow_path,28883369,1.382,-0.786,-0.000,167.55,169.56,3.490,-12.220*74 [GPS=28883.381s r=1] STM32 UART5 CTRL: $CTRL,0.410,-0.011,76.92,1506,1252,follow_path,28883381,1.382,-0.786,-0.000,167.54,169.56,3.490,-12.220*70 [GPS=28883.392s r=1] STM32 UART5 CTRL: $CTRL,0.411,0.014,76.92,1493,1251,follow_path,28883392,1.391,-0.827,-0.000,167.61,169.56,3.490,-12.220*55 [GPS=28883.415s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.012,76.92,1506,1251,follow_path,28883415,1.391,-0.827,-0.000,167.61,169.56,3.490,-12.220*7B [GPS=28883.427s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.005,76.92,1503,1251,follow_path,28883427,1.391,-0.827,-0.000,167.62,169.56,3.490,-12.220*7A [GPS=28883.439s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.013,76.92,1506,1251,follow_path,28883439,1.391,-0.827,-0.000,167.60,169.56,3.490,-12.220*75 [GPS=28883.445s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.010,76.92,1505,1251,follow_path,28883445,1.391,-0.827,-0.000,167.60,169.56,3.490,-12.220*7E [GPS=28883.469s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.012,76.92,1506,1251,follow_path,28883469,1.391,-0.827,-0.000,167.59,169.56,3.490,-12.220*7B [GPS=28883.481s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.012,76.92,1506,1251,follow_path,28883481,1.391,-0.827,-0.000,167.58,169.56,3.490,-12.220*7C [GPS=28883.492s r=1] STM32 UART5 CTRL: $CTRL,0.411,-0.013,76.92,1506,1251,follow_path,28883492,1.391,-0.827,-0.000,167.57,169.56,3.490,-12.220*70 [GPS=28883.498s r=1] STM32 UART5 CTRL: $CTRL,0.412,0.016,76.92,1492,1250,follow_path,28883498,1.400,-0.867,-0.000,167.66,169.57,3.490,-12.220*54 [GPS=28883.510s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.013,76.92,1506,1250,follow_path,28883510,1.400,-0.867,-0.000,167.64,169.57,3.490,-12.220*73 [GPS=28883.534s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.010,76.92,1505,1250,follow_path,28883534,1.400,-0.867,-0.000,167.64,169.57,3.490,-12.220*75 [GPS=28883.545s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.012,76.92,1506,1251,follow_path,28883545,1.400,-0.867,-0.000,167.63,169.57,3.490,-12.220*74 [GPS=28883.557s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.012,76.92,1506,1251,follow_path,28883557,1.400,-0.867,-0.000,167.63,169.57,3.490,-12.220*77 [GPS=28883.563s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.012,76.92,1506,1251,follow_path,28883563,1.400,-0.867,-0.000,167.62,169.57,3.490,-12.220*71 [GPS=28883.575s r=1] STM32 UART5 CTRL: $CTRL,0.412,-0.014,76.92,1507,1251,follow_path,28883575,1.400,-0.867,-0.000,167.61,169.57,3.490,-12.220*72 [GPS=28883.587s r=1] STM32 UART5 CTRL: $CTRL,0.413,0.020,76.92,1490,1250,follow_path,28883587,1.409,-0.907,-0.000,167.71,169.58,3.490,-12.220*5A [GPS=28883.611s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.009,76.92,1504,1250,follow_path,28883611,1.409,-0.907,-0.000,167.71,169.58,3.490,-12.220*7C [GPS=28883.623s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.003,76.92,1502,1250,follow_path,28883623,1.409,-0.907,-0.000,167.72,169.58,3.490,-12.220*72 [GPS=28883.629s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.008,76.92,1504,1250,follow_path,28883629,1.409,-0.907,-0.000,167.72,169.58,3.490,-12.220*75 [GPS=28883.640s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.010,76.92,1505,1250,follow_path,28883640,1.409,-0.907,-0.000,167.72,169.58,3.490,-12.220*72 [GPS=28883.652s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.011,76.92,1506,1250,follow_path,28883652,1.409,-0.907,-0.000,167.72,169.58,3.490,-12.220*73 [GPS=28883.676s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.013,76.92,1506,1250,follow_path,28883676,1.409,-0.907,-0.000,167.71,169.58,3.490,-12.220*74 [GPS=28883.688s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.013,76.92,1506,1250,follow_path,28883688,1.409,-0.907,-0.000,167.70,169.58,3.490,-12.220*74 [GPS=28883.700s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.001,76.92,1510,1249,follow_path,28883700,1.418,-0.948,-0.000,167.73,169.58,3.490,-12.220*76 [GPS=28883.706s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.014,76.92,1507,1250,follow_path,28883706,1.418,-0.948,-0.000,167.72,169.58,3.490,-12.220*7B [GPS=28883.718s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.011,76.92,1505,1250,follow_path,28883718,1.418,-0.948,-0.000,167.72,169.58,3.490,-12.220*73 [GPS=28883.741s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.013,76.92,1507,1250,follow_path,28883741,1.418,-0.948,-0.000,167.71,169.58,3.490,-12.220*7C [GPS=28883.753s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.015,76.92,1507,1250,follow_path,28883753,1.418,-0.948,-0.000,167.70,169.58,3.490,-12.220*78 [GPS=28883.759s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.015,76.92,1507,1250,follow_path,28883759,1.418,-0.948,-0.000,167.69,169.58,3.490,-12.220*7A [GPS=28883.771s r=1] STM32 UART5 CTRL: $CTRL,0.414,-0.015,76.92,1507,1250,follow_path,28883771,1.418,-0.948,-0.000,167.68,169.58,3.490,-12.220*71 [GPS=28883.783s r=1] STM32 UART5 CTRL: $CTRL,0.413,-0.015,76.92,1507,1250,follow_path,28883783,1.418,-0.948,-0.000,167.67,169.58,3.490,-12.220*74 [GPS=28883.795s r=1] STM32 UART5 CTRL: $CTRL,0.415,0.028,76.92,1486,1249,follow_path,28883795,1.427,-0.989,0.000,167.80,169.59,3.490,-12.220*72 [GPS=28883.819s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.009,76.92,1505,1249,follow_path,28883819,1.427,-0.989,0.000,167.80,169.59,3.490,-12.220*5D [GPS=28883.825s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.004,76.92,1502,1249,follow_path,28883825,1.427,-0.989,0.000,167.82,169.59,3.490,-12.220*5A [GPS=28883.836s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.013,76.92,1506,1249,follow_path,28883836,1.427,-0.989,0.000,167.81,169.59,3.490,-12.220*59 [GPS=28883.848s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.011,76.92,1505,1249,follow_path,28883848,1.427,-0.989,0.000,167.81,169.59,3.490,-12.220*51 [GPS=28883.860s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.013,76.92,1507,1249,follow_path,28883860,1.427,-0.989,0.000,167.80,169.59,3.490,-12.220*5A [GPS=28883.884s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.013,76.92,1507,1249,follow_path,28883884,1.427,-0.989,0.000,167.79,169.59,3.490,-12.220*56 [GPS=28883.890s r=1] STM32 UART5 CTRL: $CTRL,0.415,-0.014,76.92,1507,1249,follow_path,28883890,1.427,-0.989,0.000,167.78,169.59,3.490,-12.220*55 [GPS=28883.902s r=1] STM32 UART5 CTRL: $CTRL,0.416,0.009,76.92,1495,1248,follow_path,28883902,1.435,-1.030,0.000,167.84,169.60,3.490,-12.220*76 [GPS=28883.914s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.014,76.92,1507,1248,follow_path,28883914,1.435,-1.030,0.000,167.83,169.60,3.490,-12.220*5D [GPS=28883.926s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.009,76.92,1505,1248,follow_path,28883926,1.435,-1.030,0.000,167.84,169.60,3.490,-12.220*55 [GPS=28883.949s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.013,76.92,1507,1248,follow_path,28883949,1.435,-1.030,0.000,167.83,169.60,3.490,-12.220*52 [GPS=28883.955s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.014,76.92,1507,1248,follow_path,28883955,1.435,-1.030,0.000,167.82,169.60,3.490,-12.220*59 [GPS=28883.967s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.013,76.92,1507,1248,follow_path,28883967,1.435,-1.030,0.000,167.82,169.60,3.490,-12.220*5F [GPS=28883.967s r=1] STM32 UART5 POSE: $POSE,1.435,-1.030,0.000,167.82,0.00,1.81,3.490,-12.220,28883967*2A [GPS=28883.979s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.016,76.92,1508,1249,follow_path,28883979,1.435,-1.030,0.000,167.80,169.60,3.490,-12.220*59 [GPS=28883.991s r=1] STM32 UART5 CTRL: $CTRL,0.416,-0.015,76.92,1507,1249,follow_path,28883991,1.435,-1.030,0.000,167.79,169.60,3.490,-12.220*55 [GPS=28884.003s r=1] STM32 UART5 CTRL: $CTRL,0.417,0.023,76.92,1489,1248,follow_path,28884003,1.444,-1.071,0.000,167.90,169.60,3.490,-12.220*7B [GPS=28884.021s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.014,76.92,1507,1248,follow_path,28884021,1.444,-1.071,0.000,167.89,169.60,3.490,-12.220*5D [GPS=28884.033s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.004,76.92,1502,1248,follow_path,28884033,1.444,-1.071,0.000,167.91,169.60,3.490,-12.220*53 [GPS=28884.044s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.014,76.92,1507,1248,follow_path,28884044,1.444,-1.071,0.000,167.90,169.60,3.490,-12.220*56 [GPS=28884.056s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.011,76.92,1506,1248,follow_path,28884056,1.444,-1.071,0.000,167.90,169.60,3.490,-12.220*51 [GPS=28884.068s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.014,76.92,1507,1248,follow_path,28884068,1.444,-1.071,0.000,167.89,169.60,3.490,-12.220*50 [GPS=28884.086s r=1] STM32 UART5 CTRL: $CTRL,0.417,-0.014,76.92,1507,1248,follow_path,28884086,1.444,-1.071,0.000,167.88,169.60,3.490,-12.220*51 [GPS=28884.086s r=1] STM32 UART5 CTRL: $CTRL,0.418,0.013,76.92,1494,1247,follow_path,28884086,1.453,-1.112,0.000,167.95,169.61,3.490,-12.220*7F [GPS=28884.110s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.014,76.92,1507,1247,follow_path,28884110,1.453,-1.112,0.000,167.94,169.61,3.490,-12.220*51 [GPS=28884.122s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.007,76.92,1503,1247,follow_path,28884122,1.453,-1.112,0.000,167.95,169.61,3.490,-12.220*57 [GPS=28884.133s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.012,76.92,1506,1247,follow_path,28884133,1.453,-1.112,0.000,167.95,169.61,3.490,-12.220*56 [GPS=28884.157s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.014,76.92,1507,1247,follow_path,28884157,1.453,-1.112,0.000,167.94,169.61,3.490,-12.220*52 [GPS=28884.163s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.014,76.92,1507,1247,follow_path,28884163,1.453,-1.112,0.000,167.93,169.61,3.490,-12.220*52 [GPS=28884.175s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.015,76.92,1508,1247,follow_path,28884175,1.453,-1.112,0.000,167.92,169.61,3.490,-12.220*5A [GPS=28884.187s r=1] STM32 UART5 CTRL: $CTRL,0.418,-0.015,76.92,1507,1247,follow_path,28884187,1.453,-1.112,0.000,167.91,169.61,3.490,-12.220*5B [GPS=28884.199s r=1] STM32 UART5 CTRL: $CTRL,0.419,0.016,76.92,1492,1247,follow_path,28884199,1.462,-1.153,0.000,168.00,169.61,3.490,-12.220*76 [GPS=28884.223s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.009,76.92,1505,1247,follow_path,28884223,1.462,-1.153,0.000,168.00,169.61,3.490,-12.220*58 [GPS=28884.229s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.007,76.92,1503,1247,follow_path,28884229,1.462,-1.153,0.000,168.01,169.61,3.490,-12.220*5B [GPS=28884.240s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.013,76.92,1506,1247,follow_path,28884240,1.462,-1.153,0.000,168.01,169.61,3.490,-12.220*54 [GPS=28884.252s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.012,76.92,1506,1247,follow_path,28884252,1.462,-1.153,0.000,168.00,169.61,3.490,-12.220*57 [GPS=28884.264s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.014,76.92,1507,1247,follow_path,28884264,1.462,-1.153,0.000,167.99,169.61,3.490,-12.220*5A [GPS=28884.276s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.013,76.92,1507,1247,follow_path,28884276,1.462,-1.153,0.000,167.99,169.61,3.490,-12.220*5E [GPS=28884.294s r=1] STM32 UART5 CTRL: $CTRL,0.419,-0.015,76.92,1508,1247,follow_path,28884294,1.462,-1.153,0.000,167.97,169.61,3.490,-12.220*55 [GPS=28884.306s r=1] STM32 UART5 CTRL: $CTRL,0.420,0.013,76.92,1494,1246,follow_path,28884306,1.471,-1.195,0.000,168.05,169.62,3.490,-12.220*74 [GPS=28884.318s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.015,76.92,1507,1246,follow_path,28884318,1.471,-1.195,0.000,168.04,169.62,3.490,-12.220*5A [GPS=28884.330s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.008,76.92,1504,1246,follow_path,28884330,1.471,-1.195,0.000,168.05,169.62,3.490,-12.220*5E [GPS=28884.341s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.015,76.92,1507,1246,follow_path,28884341,1.471,-1.195,0.000,168.04,169.62,3.490,-12.220*56 [GPS=28884.359s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.013,76.92,1507,1246,follow_path,28884359,1.471,-1.195,0.000,168.03,169.62,3.490,-12.220*5E [GPS=28884.359s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.033,-1.59,28884359*28 [GPS=28884.371s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.016,76.92,1508,1246,follow_path,28884371,1.471,-1.195,0.000,168.02,169.62,3.490,-12.220*5F [GPS=28884.383s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.015,76.92,1508,1246,follow_path,28884383,1.471,-1.195,0.000,168.01,169.62,3.490,-12.220*52 [GPS=28884.394s r=1] STM32 UART5 CTRL: $CTRL,0.420,-0.016,76.92,1508,1247,follow_path,28884394,1.471,-1.195,0.000,168.00,169.62,3.490,-12.220*57 [GPS=28884.406s r=1] STM32 UART5 CTRL: $CTRL,0.421,0.025,76.92,1488,1246,follow_path,28884406,1.479,-1.236,0.000,168.11,169.63,3.490,-12.220*7C [GPS=28884.424s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.015,76.92,1508,1246,follow_path,28884424,1.479,-1.236,0.000,168.10,169.63,3.490,-12.220*5A [GPS=28884.436s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.006,76.92,1503,1246,follow_path,28884436,1.479,-1.236,0.000,168.11,169.63,3.490,-12.220*51 [GPS=28884.448s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.015,76.92,1507,1246,follow_path,28884448,1.479,-1.236,0.000,168.10,169.63,3.490,-12.220*5F [GPS=28884.460s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.013,76.92,1506,1246,follow_path,28884460,1.479,-1.236,0.000,168.09,169.63,3.490,-12.220*5A [GPS=28884.472s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.015,76.92,1507,1246,follow_path,28884472,1.479,-1.236,0.000,168.08,169.63,3.490,-12.220*5F [GPS=28884.494s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.015,76.92,1508,1246,follow_path,28884494,1.479,-1.236,0.000,168.07,169.63,3.490,-12.220*57 [GPS=28884.494s r=1] STM32 UART5 CTRL: $CTRL,0.421,-0.015,76.92,1508,1246,follow_path,28884494,1.479,-1.236,0.000,168.06,169.63,3.490,-12.220*56 [GPS=28884.512s r=1] STM32 UART5 CTRL: $CTRL,0.422,0.022,76.92,1489,1245,follow_path,28884512,1.488,-1.277,0.000,168.16,169.63,3.490,-12.220*72 [GPS=28884.524s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.015,76.92,1507,1245,follow_path,28884524,1.488,-1.277,0.000,168.15,169.63,3.490,-12.220*5A [GPS=28884.536s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.004,76.92,1502,1245,follow_path,28884536,1.488,-1.277,0.000,168.17,169.63,3.490,-12.220*5E [GPS=28884.554s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.015,76.92,1507,1245,follow_path,28884554,1.488,-1.277,0.000,168.16,169.63,3.490,-12.220*5E [GPS=28884.566s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.012,76.92,1506,1245,follow_path,28884566,1.488,-1.277,0.000,168.15,169.63,3.490,-12.220*5A [GPS=28884.578s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.015,76.92,1508,1245,follow_path,28884578,1.488,-1.277,0.000,168.14,169.63,3.490,-12.220*5D [GPS=28884.590s r=1] STM32 UART5 CTRL: $CTRL,0.422,-0.014,76.92,1507,1245,follow_path,28884590,1.488,-1.277,0.000,168.13,169.63,3.490,-12.220*52 [GPS=28884.602s r=1] STM32 UART5 CTRL: $CTRL,0.423,0.013,76.92,1494,1245,follow_path,28884602,1.497,-1.319,0.000,168.21,169.64,3.490,-12.220*7B [GPS=28884.620s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.015,76.92,1507,1245,follow_path,28884620,1.497,-1.319,0.000,168.20,169.64,3.490,-12.220*5A [GPS=28884.632s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.007,76.92,1504,1245,follow_path,28884632,1.497,-1.319,0.000,168.21,169.64,3.490,-12.220*58 [GPS=28884.643s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.014,76.92,1507,1245,follow_path,28884643,1.497,-1.319,0.000,168.20,169.64,3.490,-12.220*5E [GPS=28884.655s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.014,76.92,1507,1245,follow_path,28884655,1.497,-1.319,0.000,168.19,169.64,3.490,-12.220*53 [GPS=28884.666s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.015,76.92,1508,1245,follow_path,28884666,1.497,-1.319,0.000,168.18,169.64,3.490,-12.220*5C [GPS=28884.678s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.015,76.92,1507,1245,follow_path,28884678,1.497,-1.319,0.000,168.17,169.64,3.490,-12.220*53 [GPS=28884.684s r=1] STM32 UART5 CTRL: $CTRL,0.423,-0.015,76.92,1508,1245,follow_path,28884684,1.497,-1.319,0.000,168.16,169.64,3.490,-12.220*5E [GPS=28884.708s r=1] STM32 UART5 CTRL: $CTRL,0.424,0.024,76.92,1488,1244,follow_path,28884708,1.505,-1.361,0.000,168.27,169.64,3.490,-12.220*7C [GPS=28884.720s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.014,76.92,1507,1244,follow_path,28884720,1.505,-1.361,0.000,168.26,169.64,3.490,-12.220*5F [GPS=28884.732s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.004,76.92,1502,1244,follow_path,28884732,1.505,-1.361,0.000,168.27,169.64,3.490,-12.220*59 [GPS=28884.743s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.014,76.92,1507,1244,follow_path,28884743,1.505,-1.361,0.000,168.26,169.64,3.490,-12.220*5A [GPS=28884.761s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.011,76.92,1505,1244,follow_path,28884761,1.505,-1.361,0.000,168.26,169.64,3.490,-12.220*5D [GPS=28884.773s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.014,76.92,1507,1244,follow_path,28884773,1.505,-1.361,0.000,168.25,169.64,3.490,-12.220*5A [GPS=28884.785s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.013,76.92,1507,1244,follow_path,28884785,1.505,-1.361,0.000,168.24,169.64,3.490,-12.220*55 [GPS=28884.797s r=1] STM32 UART5 CTRL: $CTRL,0.424,-0.014,76.92,1507,1244,follow_path,28884797,1.505,-1.361,0.000,168.23,169.64,3.490,-12.220*56 [GPS=28884.809s r=1] STM32 UART5 CTRL: $CTRL,0.425,0.015,76.92,1493,1244,follow_path,28884809,1.514,-1.402,0.000,168.32,169.65,3.490,-12.220*7C [GPS=28884.827s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.013,76.92,1507,1244,follow_path,28884827,1.514,-1.402,0.000,168.31,169.65,3.490,-12.220*54 [GPS=28884.838s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.007,76.92,1504,1244,follow_path,28884838,1.514,-1.402,0.000,168.32,169.65,3.490,-12.220*5F [GPS=28884.850s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.014,76.92,1507,1244,follow_path,28884850,1.514,-1.402,0.000,168.31,169.65,3.490,-12.220*53 [GPS=28884.862s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.012,76.92,1506,1244,follow_path,28884862,1.514,-1.402,0.000,168.30,169.65,3.490,-12.220*54 [GPS=28884.874s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.015,76.92,1507,1244,follow_path,28884874,1.514,-1.402,0.000,168.29,169.65,3.490,-12.220*5D [GPS=28884.892s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.013,76.92,1506,1244,follow_path,28884892,1.514,-1.402,0.000,168.28,169.65,3.490,-12.220*53 [GPS=28884.892s r=1] STM32 UART5 CTRL: $CTRL,0.425,-0.013,76.92,1506,1244,follow_path,28884892,1.514,-1.402,0.000,168.28,169.65,3.490,-12.220*53 [GPS=28884.916s r=1] STM32 UART5 CTRL: $CTRL,0.426,0.019,76.92,1491,1243,follow_path,28884916,1.523,-1.444,0.000,168.37,169.65,3.490,-12.220*7A [GPS=28884.928s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.013,76.92,1506,1243,follow_path,28884928,1.523,-1.444,0.000,168.36,169.65,3.490,-12.220*5E [GPS=28884.939s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.004,76.92,1502,1243,follow_path,28884939,1.523,-1.444,0.000,168.38,169.65,3.490,-12.220*52 [GPS=28884.945s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.010,76.92,1505,1243,follow_path,28884945,1.523,-1.444,0.000,168.38,169.65,3.490,-12.220*5B [GPS=28884.969s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.011,76.92,1506,1243,follow_path,28884969,1.523,-1.444,0.000,168.37,169.65,3.490,-12.220*58 [GPS=28884.969s r=1] STM32 UART5 POSE: $POSE,1.523,-1.444,0.000,168.37,0.00,2.13,3.490,-12.220,28884969*2B [GPS=28884.981s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.014,76.92,1507,1243,follow_path,28884981,1.523,-1.444,0.000,168.36,169.65,3.490,-12.220*5B [GPS=28884.993s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.013,76.92,1506,1243,follow_path,28884993,1.523,-1.444,0.000,168.35,169.65,3.490,-12.220*5D [GPS=28885.005s r=1] STM32 UART5 CTRL: $CTRL,0.426,-0.014,76.92,1507,1243,follow_path,28885005,1.523,-1.444,0.000,168.34,169.65,3.490,-12.220*5D [GPS=28885.017s r=1] STM32 UART5 CTRL: $CTRL,0.427,0.013,76.92,1494,1243,follow_path,28885017,1.531,-1.487,0.000,168.42,169.66,3.490,-12.220*70 [GPS=28885.034s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.014,76.92,1507,1243,follow_path,28885034,1.531,-1.487,0.000,168.40,169.66,3.490,-12.220*52 [GPS=28885.047s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.006,76.92,1503,1243,follow_path,28885047,1.531,-1.487,0.000,168.42,169.66,3.490,-12.220*53 [GPS=28885.058s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.013,76.92,1506,1243,follow_path,28885058,1.531,-1.487,0.000,168.41,169.66,3.490,-12.220*5F [GPS=28885.070s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.012,76.92,1506,1243,follow_path,28885070,1.531,-1.487,0.000,168.40,169.66,3.490,-12.220*55 [GPS=28885.076s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.014,76.92,1507,1243,follow_path,28885076,1.531,-1.487,0.000,168.39,169.66,3.490,-12.220*5A [GPS=28885.093s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.014,76.92,1507,1243,follow_path,28885093,1.531,-1.487,0.000,168.38,169.66,3.490,-12.220*50 [GPS=28885.104s r=1] STM32 UART5 CTRL: $CTRL,0.428,0.018,76.92,1491,1242,follow_path,28885104,1.540,-1.528,0.000,168.47,169.66,3.490,-12.220*74 [GPS=28885.122s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.013,76.92,1507,1242,follow_path,28885122,1.540,-1.528,0.000,168.46,169.66,3.490,-12.220*59 [GPS=28885.134s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.005,76.92,1502,1242,follow_path,28885134,1.540,-1.528,0.000,168.47,169.66,3.490,-12.220*5D [GPS=28885.146s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.013,76.92,1506,1242,follow_path,28885146,1.540,-1.528,0.000,168.46,169.66,3.490,-12.220*5A [GPS=28885.158s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.011,76.92,1505,1242,follow_path,28885158,1.540,-1.528,0.000,168.46,169.66,3.490,-12.220*54 [GPS=28885.176s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.013,76.92,1507,1243,follow_path,28885176,1.540,-1.528,0.000,168.45,169.66,3.490,-12.220*5A [GPS=28885.187s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.012,76.92,1506,1243,follow_path,28885187,1.540,-1.528,0.000,168.44,169.66,3.490,-12.220*55 [GPS=28885.199s r=1] STM32 UART5 CTRL: $CTRL,0.427,-0.014,76.92,1507,1243,follow_path,28885199,1.540,-1.528,0.000,168.43,169.66,3.490,-12.220*55 [GPS=28885.211s r=1] STM32 UART5 CTRL: $CTRL,0.429,0.019,76.92,1491,1242,follow_path,28885211,1.548,-1.571,0.000,168.52,169.67,3.490,-12.220*72 [GPS=28885.223s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.012,76.92,1506,1242,follow_path,28885223,1.548,-1.571,0.000,168.51,169.67,3.490,-12.220*59 [GPS=28885.241s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.005,76.92,1502,1242,follow_path,28885241,1.548,-1.571,0.000,168.52,169.67,3.490,-12.220*5C [GPS=28885.253s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.012,76.92,1506,1242,follow_path,28885253,1.548,-1.571,0.000,168.51,169.67,3.490,-12.220*5E [GPS=28885.265s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.011,76.92,1505,1242,follow_path,28885265,1.548,-1.571,0.000,168.51,169.67,3.490,-12.220*5B [GPS=28885.277s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.012,76.92,1506,1242,follow_path,28885277,1.548,-1.571,0.000,168.50,169.67,3.490,-12.220*59 [GPS=28885.289s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.012,76.92,1506,1242,follow_path,28885289,1.548,-1.571,0.000,168.49,169.67,3.490,-12.220*51 [GPS=28885.301s r=1] STM32 UART5 CTRL: $CTRL,0.428,-0.013,76.92,1506,1242,follow_path,28885301,1.548,-1.571,0.000,168.48,169.67,3.490,-12.220*50 [GPS=28885.319s r=1] STM32 UART5 CTRL: $CTRL,0.429,0.011,76.92,1495,1242,follow_path,28885319,1.557,-1.613,0.000,168.55,169.67,3.490,-12.220*79 [GPS=28885.331s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.013,76.92,1506,1242,follow_path,28885331,1.557,-1.613,0.000,168.54,169.67,3.490,-12.220*56 [GPS=28885.342s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.007,76.92,1503,1242,follow_path,28885342,1.557,-1.613,0.000,168.55,169.67,3.490,-12.220*53 [GPS=28885.354s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.013,76.92,1506,1242,follow_path,28885354,1.557,-1.613,0.000,168.54,169.67,3.490,-12.220*55 [GPS=28885.354s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.022,-1.13,28885354*2A [GPS=28885.366s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.011,76.92,1505,1242,follow_path,28885366,1.557,-1.613,0.000,168.53,169.67,3.490,-12.220*52 [GPS=28885.384s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.013,76.92,1507,1242,follow_path,28885384,1.557,-1.613,0.000,168.52,169.67,3.490,-12.220*5F [GPS=28885.396s r=1] STM32 UART5 CTRL: $CTRL,0.429,-0.013,76.92,1507,1242,follow_path,28885396,1.557,-1.613,0.000,168.51,169.67,3.490,-12.220*5F [GPS=28885.396s r=1] STM32 UART5 CTRL: $CTRL,0.430,0.019,76.92,1491,1241,follow_path,28885396,1.566,-1.656,0.000,168.60,169.68,3.490,-12.220*73 [GPS=28885.420s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.013,76.92,1506,1241,follow_path,28885420,1.566,-1.656,0.000,168.59,169.68,3.490,-12.220*5B [GPS=28885.426s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.008,76.92,1504,1241,follow_path,28885426,1.566,-1.656,0.000,168.60,169.68,3.490,-12.220*5F [GPS=28885.449s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.012,76.92,1506,1241,follow_path,28885449,1.566,-1.656,0.000,168.59,169.68,3.490,-12.220*55 [GPS=28885.461s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.012,76.92,1506,1241,follow_path,28885461,1.566,-1.656,0.000,168.58,169.68,3.490,-12.220*5E [GPS=28885.473s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.013,76.92,1506,1241,follow_path,28885473,1.566,-1.656,0.000,168.57,169.68,3.490,-12.220*53 [GPS=28885.485s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.013,76.92,1506,1241,follow_path,28885485,1.566,-1.656,0.000,168.56,169.68,3.490,-12.220*5B [GPS=28885.491s r=1] STM32 UART5 CTRL: $CTRL,0.430,-0.013,76.92,1506,1241,follow_path,28885491,1.566,-1.656,0.000,168.55,169.68,3.490,-12.220*5D [GPS=28885.503s r=1] STM32 UART5 CTRL: $CTRL,0.431,0.022,76.92,1489,1241,follow_path,28885503,1.574,-1.698,0.000,168.65,169.68,3.490,-12.220*7D [GPS=28885.527s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.007,76.92,1504,1241,follow_path,28885527,1.574,-1.698,0.000,168.65,169.68,3.490,-12.220*55 [GPS=28885.539s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.002,76.92,1501,1241,follow_path,28885539,1.574,-1.698,0.000,168.67,169.68,3.490,-12.220*58 [GPS=28885.551s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.009,76.92,1505,1241,follow_path,28885551,1.574,-1.698,0.000,168.67,169.68,3.490,-12.220*59 [GPS=28885.563s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.009,76.92,1504,1241,follow_path,28885563,1.574,-1.698,0.000,168.67,169.68,3.490,-12.220*59 [GPS=28885.569s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.011,76.92,1505,1241,follow_path,28885569,1.574,-1.698,0.000,168.66,169.68,3.490,-12.220*5A [GPS=28885.581s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.011,76.92,1505,1241,follow_path,28885581,1.574,-1.698,0.000,168.65,169.68,3.490,-12.220*5F [GPS=28885.604s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.011,76.92,1506,1241,follow_path,28885604,1.574,-1.698,0.000,168.64,169.68,3.490,-12.220*53 [GPS=28885.616s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.000,76.92,1510,1241,follow_path,28885616,1.583,-1.741,0.000,168.67,169.68,3.490,-12.220*5A [GPS=28885.622s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.011,76.92,1506,1241,follow_path,28885622,1.583,-1.741,0.000,168.67,169.68,3.490,-12.220*5A [GPS=28885.634s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.009,76.92,1504,1241,follow_path,28885634,1.583,-1.741,0.000,168.67,169.68,3.490,-12.220*56 [GPS=28885.658s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.011,76.92,1505,1241,follow_path,28885658,1.583,-1.741,0.000,168.66,169.68,3.490,-12.220*56 [GPS=28885.670s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.011,76.92,1506,1241,follow_path,28885670,1.583,-1.741,0.000,168.65,169.68,3.490,-12.220*5C [GPS=28885.682s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.012,76.92,1506,1241,follow_path,28885682,1.583,-1.741,0.000,168.65,169.68,3.490,-12.220*52 [GPS=28885.694s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.013,76.92,1506,1241,follow_path,28885694,1.583,-1.741,0.000,168.64,169.68,3.490,-12.220*55 [GPS=28885.700s r=1] STM32 UART5 CTRL: $CTRL,0.431,-0.013,76.92,1506,1241,follow_path,28885700,1.583,-1.741,0.000,168.63,169.68,3.490,-12.220*5E [GPS=28885.712s r=1] STM32 UART5 CTRL: $CTRL,0.432,0.022,76.92,1489,1240,follow_path,28885712,1.591,-1.782,0.000,168.73,169.69,3.490,-12.220*7A [GPS=28885.736s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.006,76.92,1503,1240,follow_path,28885736,1.591,-1.782,0.000,168.73,169.69,3.490,-12.220*54 [GPS=28885.748s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.007,76.92,1503,1240,follow_path,28885748,1.591,-1.782,0.000,168.73,169.69,3.490,-12.220*5D [GPS=28885.760s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.009,76.92,1505,1240,follow_path,28885760,1.591,-1.782,0.000,168.73,169.69,3.490,-12.220*5E [GPS=28885.766s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.010,76.92,1505,1240,follow_path,28885766,1.591,-1.782,0.000,168.72,169.69,3.490,-12.220*51 [GPS=28885.778s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.011,76.92,1506,1240,follow_path,28885778,1.591,-1.782,0.000,168.72,169.69,3.490,-12.220*5C [GPS=28885.802s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.011,76.92,1505,1240,follow_path,28885802,1.591,-1.782,0.000,168.71,169.69,3.490,-12.220*5E [GPS=28885.802s r=1] STM32 UART5 CTRL: $CTRL,0.432,-0.011,76.92,1505,1240,follow_path,28885802,1.591,-1.782,0.000,168.70,169.69,3.490,-12.220*5F [GPS=28885.826s r=1] STM32 UART5 CTRL: $CTRL,0.433,0.010,76.92,1495,1240,follow_path,28885826,1.599,-1.825,0.000,168.76,169.69,3.490,-12.220*70 [GPS=28885.832s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.011,76.92,1506,1240,follow_path,28885832,1.599,-1.825,0.000,168.75,169.69,3.490,-12.220*51 [GPS=28885.844s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.005,76.92,1503,1240,follow_path,28885844,1.599,-1.825,0.000,168.76,169.69,3.490,-12.220*53 [GPS=28885.856s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.011,76.92,1505,1240,follow_path,28885856,1.599,-1.825,0.000,168.75,169.69,3.490,-12.220*50 [GPS=28885.879s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.012,76.92,1506,1240,follow_path,28885879,1.599,-1.825,0.000,168.74,169.69,3.490,-12.220*5C [GPS=28885.891s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.011,76.92,1506,1240,follow_path,28885891,1.599,-1.825,0.000,168.73,169.69,3.490,-12.220*5E [GPS=28885.897s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.012,76.92,1506,1240,follow_path,28885897,1.599,-1.825,0.000,168.72,169.69,3.490,-12.220*5A [GPS=28885.909s r=1] STM32 UART5 CTRL: $CTRL,0.433,-0.012,76.92,1506,1240,follow_path,28885909,1.599,-1.825,0.000,168.72,169.69,3.490,-12.220*5C [GPS=28885.921s r=1] STM32 UART5 CTRL: $CTRL,0.434,0.018,76.92,1491,1239,follow_path,28885921,1.608,-1.868,-0.000,168.80,169.70,3.490,-12.220*5D [GPS=28885.945s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.005,76.92,1503,1239,follow_path,28885945,1.608,-1.868,-0.000,168.81,169.70,3.490,-12.220*75 [GPS=28885.951s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.003,76.92,1502,1239,follow_path,28885951,1.608,-1.868,-0.000,168.82,169.70,3.490,-12.220*74 [GPS=28885.963s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.008,76.92,1504,1239,follow_path,28885963,1.608,-1.868,-0.000,168.82,169.70,3.490,-12.220*78 [GPS=28885.963s r=1] STM32 UART5 POSE: $POSE,1.608,-1.868,-0.000,168.82,0.00,1.59,3.490,-12.220,28885963*06 [GPS=28885.975s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.009,76.92,1504,1239,follow_path,28885975,1.608,-1.868,-0.000,168.81,169.70,3.490,-12.220*7D [GPS=28885.986s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.010,76.92,1505,1239,follow_path,28885986,1.608,-1.868,-0.000,168.81,169.70,3.490,-12.220*78 [GPS=28885.998s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.010,76.92,1505,1239,follow_path,28885998,1.608,-1.868,-0.000,168.80,169.70,3.490,-12.220*76 [GPS=28886.010s r=1] STM32 UART5 CTRL: $CTRL,0.434,0.002,76.92,1499,1239,follow_path,28886010,1.616,-1.911,-0.000,168.83,169.70,3.490,-12.220*55 [GPS=28886.029s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.010,76.92,1505,1239,follow_path,28886029,1.616,-1.911,-0.000,168.83,169.70,3.490,-12.220*75 [GPS=28886.040s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.008,76.92,1504,1239,follow_path,28886040,1.616,-1.911,-0.000,168.83,169.70,3.490,-12.220*72 [GPS=28886.052s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.011,76.92,1505,1239,follow_path,28886052,1.616,-1.911,-0.000,168.82,169.70,3.490,-12.220*79 [GPS=28886.064s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.010,76.92,1505,1239,follow_path,28886064,1.616,-1.911,-0.000,168.81,169.70,3.490,-12.220*7E [GPS=28886.082s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.012,76.92,1506,1239,follow_path,28886082,1.616,-1.911,-0.000,168.80,169.70,3.490,-12.220*76 [GPS=28886.094s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.012,76.92,1506,1239,follow_path,28886094,1.616,-1.911,-0.000,168.79,169.70,3.490,-12.220*77 [GPS=28886.106s r=1] STM32 UART5 CTRL: $CTRL,0.434,-0.012,76.92,1506,1239,follow_path,28886106,1.616,-1.911,-0.000,168.79,169.70,3.490,-12.220*7D [GPS=28886.118s r=1] STM32 UART5 CTRL: $CTRL,0.435,0.025,76.92,1488,1239,follow_path,28886118,1.625,-1.954,-0.000,168.89,169.70,3.490,-12.220*53 [GPS=28886.130s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.010,76.92,1505,1239,follow_path,28886130,1.625,-1.954,-0.000,168.88,169.70,3.490,-12.220*77 [GPS=28886.142s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.001,76.92,1510,1239,follow_path,28886142,1.625,-1.954,-0.000,168.90,169.70,3.490,-12.220*7F [GPS=28886.160s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.009,76.92,1505,1239,follow_path,28886160,1.625,-1.954,-0.000,168.89,169.70,3.490,-12.220*7B [GPS=28886.172s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.007,76.92,1503,1239,follow_path,28886172,1.625,-1.954,-0.000,168.89,169.70,3.490,-12.220*70 [GPS=28886.184s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.010,76.92,1505,1239,follow_path,28886184,1.625,-1.954,-0.000,168.88,169.70,3.490,-12.220*78 [GPS=28886.196s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.009,76.92,1504,1239,follow_path,28886196,1.625,-1.954,-0.000,168.88,169.70,3.490,-12.220*72 [GPS=28886.208s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.010,76.92,1505,1239,follow_path,28886208,1.625,-1.954,-0.000,168.87,169.70,3.490,-12.220*70 [GPS=28886.220s r=1] STM32 UART5 CTRL: $CTRL,0.436,0.002,76.92,1499,1238,follow_path,28886220,1.634,-1.997,-0.000,168.90,169.71,3.490,-12.220*5A [GPS=28886.237s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.011,76.92,1505,1239,follow_path,28886237,1.634,-1.997,-0.000,168.89,169.71,3.490,-12.220*7D [GPS=28886.249s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.008,76.92,1504,1239,follow_path,28886249,1.634,-1.997,-0.000,168.89,169.71,3.490,-12.220*7D [GPS=28886.261s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.011,76.92,1505,1239,follow_path,28886261,1.634,-1.997,-0.000,168.89,169.71,3.490,-12.220*7E [GPS=28886.273s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.011,76.92,1505,1239,follow_path,28886273,1.634,-1.997,-0.000,168.88,169.71,3.490,-12.220*7C [GPS=28886.285s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.012,76.92,1506,1239,follow_path,28886285,1.634,-1.997,-0.000,168.87,169.71,3.490,-12.220*7A [GPS=28886.303s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.012,76.92,1506,1239,follow_path,28886303,1.634,-1.997,-0.000,168.86,169.71,3.490,-12.220*74 [GPS=28886.303s r=1] STM32 UART5 CTRL: $CTRL,0.435,-0.012,76.92,1506,1239,follow_path,28886303,1.634,-1.997,-0.000,168.85,169.71,3.490,-12.220*77 [GPS=28886.327s r=1] STM32 UART5 CTRL: $CTRL,0.436,0.026,76.92,1487,1238,follow_path,28886327,1.642,-2.041,-0.000,168.95,169.71,3.490,-12.220*50 [GPS=28886.339s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.010,76.92,1505,1238,follow_path,28886339,1.642,-2.041,-0.000,168.94,169.71,3.490,-12.220*7D [GPS=28886.351s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.000,76.92,1510,1238,follow_path,28886351,1.642,-2.041,-0.000,168.96,169.71,3.490,-12.220*74 [GPS=28886.351s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.014,-0.75,28886351*28 [GPS=28886.357s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.005,76.92,1502,1238,follow_path,28886357,1.642,-2.041,-0.000,168.97,169.71,3.490,-12.220*75 [GPS=28886.381s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.007,76.92,1503,1238,follow_path,28886381,1.642,-2.041,-0.000,168.97,169.71,3.490,-12.220*7D [GPS=28886.393s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.007,76.92,1503,1238,follow_path,28886393,1.642,-2.041,-0.000,168.96,169.71,3.490,-12.220*7F [GPS=28886.405s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.008,76.92,1504,1238,follow_path,28886405,1.642,-2.041,-0.000,168.96,169.71,3.490,-12.220*7F [GPS=28886.405s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.003,76.92,1501,1238,follow_path,28886405,1.650,-2.084,-0.000,168.98,169.71,3.490,-12.220*74 [GPS=28886.428s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.009,76.92,1504,1238,follow_path,28886428,1.650,-2.084,-0.000,168.97,169.71,3.490,-12.220*7B [GPS=28886.446s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.008,76.92,1504,1238,follow_path,28886446,1.650,-2.084,-0.000,168.97,169.71,3.490,-12.220*72 [GPS=28886.458s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.010,76.92,1505,1238,follow_path,28886458,1.650,-2.084,-0.000,168.96,169.71,3.490,-12.220*74 [GPS=28886.470s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.010,76.92,1505,1238,follow_path,28886470,1.650,-2.084,-0.000,168.95,169.71,3.490,-12.220*7D [GPS=28886.482s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.010,76.92,1505,1238,follow_path,28886482,1.650,-2.084,-0.000,168.95,169.71,3.490,-12.220*71 [GPS=28886.494s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.010,76.92,1505,1238,follow_path,28886494,1.650,-2.084,-0.000,168.94,169.71,3.490,-12.220*77 [GPS=28886.506s r=1] STM32 UART5 CTRL: $CTRL,0.436,-0.011,76.92,1505,1238,follow_path,28886506,1.650,-2.084,-0.000,168.93,169.71,3.490,-12.220*7B [GPS=28886.512s r=1] STM32 UART5 CTRL: $CTRL,0.437,0.021,76.92,1490,1238,follow_path,28886512,1.658,-2.125,-0.000,169.02,169.72,3.490,-12.220*54 [GPS=28886.536s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.009,76.92,1504,1238,follow_path,28886536,1.658,-2.125,-0.000,169.01,169.72,3.490,-12.220*7A [GPS=28886.548s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.001,76.92,1510,1237,follow_path,28886548,1.658,-2.125,-0.000,169.03,169.72,3.490,-12.220*7C [GPS=28886.560s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.008,76.92,1504,1238,follow_path,28886560,1.658,-2.125,-0.000,169.02,169.72,3.490,-12.220*7B [GPS=28886.566s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.007,76.92,1503,1238,follow_path,28886566,1.658,-2.125,-0.000,169.02,169.72,3.490,-12.220*75 [GPS=28886.590s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.008,76.92,1504,1238,follow_path,28886590,1.658,-2.125,-0.000,169.02,169.72,3.490,-12.220*74 [GPS=28886.602s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.007,76.92,1504,1238,follow_path,28886602,1.658,-2.125,-0.000,169.01,169.72,3.490,-12.220*70 [GPS=28886.614s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.008,76.92,1504,1238,follow_path,28886614,1.658,-2.125,-0.000,169.01,169.72,3.490,-12.220*78 [GPS=28886.625s r=1] STM32 UART5 CTRL: $CTRL,0.438,0.005,76.92,1498,1237,follow_path,28886625,1.667,-2.169,-0.000,169.04,169.72,3.490,-12.220*5F [GPS=28886.637s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.008,76.92,1504,1237,follow_path,28886637,1.667,-2.169,-0.000,169.04,169.72,3.490,-12.220*78 [GPS=28886.655s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.009,76.92,1504,1237,follow_path,28886655,1.667,-2.169,-0.000,169.03,169.72,3.490,-12.220*7A [GPS=28886.667s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.009,76.92,1504,1237,follow_path,28886667,1.667,-2.169,-0.000,169.03,169.72,3.490,-12.220*7B [GPS=28886.678s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.010,76.92,1505,1237,follow_path,28886678,1.667,-2.169,-0.000,169.02,169.72,3.490,-12.220*7D [GPS=28886.690s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.010,76.92,1505,1237,follow_path,28886690,1.667,-2.169,-0.000,169.01,169.72,3.490,-12.220*78 [GPS=28886.701s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.009,76.92,1505,1238,follow_path,28886701,1.667,-2.169,-0.000,169.01,169.72,3.490,-12.220*79 [GPS=28886.713s r=1] STM32 UART5 CTRL: $CTRL,0.437,-0.010,76.92,1505,1238,follow_path,28886713,1.667,-2.169,-0.000,169.00,169.72,3.490,-12.220*73 [GPS=28886.731s r=1] STM32 UART5 CTRL: $CTRL,0.439,0.022,76.92,1490,1237,follow_path,28886731,1.675,-2.212,-0.000,169.08,169.72,3.490,-12.220*57 [GPS=28886.743s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.009,76.92,1504,1237,follow_path,28886743,1.675,-2.212,-0.000,169.08,169.72,3.490,-12.220*7B [GPS=28886.755s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.000,76.92,1510,1237,follow_path,28886755,1.675,-2.212,-0.000,169.09,169.72,3.490,-12.220*70 [GPS=28886.766s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.008,76.92,1504,1237,follow_path,28886766,1.675,-2.212,-0.000,169.09,169.72,3.490,-12.220*7D [GPS=28886.772s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.006,76.92,1503,1237,follow_path,28886772,1.675,-2.212,-0.000,169.09,169.72,3.490,-12.220*71 [GPS=28886.797s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.008,76.92,1504,1237,follow_path,28886797,1.675,-2.212,-0.000,169.08,169.72,3.490,-12.220*73 [GPS=28886.808s r=1] STM32 UART5 CTRL: $CTRL,0.438,-0.007,76.92,1504,1237,follow_path,28886808,1.675,-2.212,-0.000,169.08,169.72,3.490,-12.220*75 [GPS=28886.808s r=1] STM32 UART5 CTRL: $CTRL,0.439,0.004,76.92,1498,1237,follow_path,28886808,1.683,-2.255,-0.000,169.11,169.72,3.490,-12.220*5C [GPS=28886.832s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1504,1237,follow_path,28886832,1.683,-2.255,-0.000,169.10,169.72,3.490,-12.220*7E [GPS=28886.844s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.006,76.92,1503,1237,follow_path,28886844,1.683,-2.255,-0.000,169.11,169.72,3.490,-12.220*78 [GPS=28886.850s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.009,76.92,1504,1237,follow_path,28886850,1.683,-2.255,-0.000,169.10,169.72,3.490,-12.220*74 [GPS=28886.874s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.009,76.92,1504,1237,follow_path,28886874,1.683,-2.255,-0.000,169.09,169.72,3.490,-12.220*7A [GPS=28886.886s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.009,76.92,1504,1237,follow_path,28886886,1.683,-2.255,-0.000,169.08,169.72,3.490,-12.220*76 [GPS=28886.898s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.008,76.92,1504,1237,follow_path,28886898,1.683,-2.255,-0.000,169.08,169.72,3.490,-12.220*78 [GPS=28886.904s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.008,76.92,1504,1237,follow_path,28886904,1.683,-2.255,-0.000,169.07,169.72,3.490,-12.220*73 [GPS=28886.916s r=1] STM32 UART5 CTRL: $CTRL,0.440,0.018,76.92,1491,1236,follow_path,28886916,1.692,-2.299,-0.000,169.15,169.73,3.490,-12.220*5C [GPS=28886.928s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1503,1236,follow_path,28886928,1.692,-2.299,-0.000,169.14,169.73,3.490,-12.220*77 [GPS=28886.952s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.005,76.92,1502,1236,follow_path,28886952,1.692,-2.299,-0.000,169.14,169.73,3.490,-12.220*79 [GPS=28886.964s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1503,1237,follow_path,28886964,1.692,-2.299,-0.000,169.14,169.73,3.490,-12.220*7E [GPS=28886.964s r=1] STM32 UART5 POSE: $POSE,1.692,-2.299,-0.000,169.14,0.00,1.18,3.490,-12.220,28886964*0D [GPS=28886.976s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1503,1237,follow_path,28886976,1.692,-2.299,-0.000,169.14,169.73,3.490,-12.220*7D [GPS=28886.982s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1503,1237,follow_path,28886982,1.692,-2.299,-0.000,169.13,169.73,3.490,-12.220*71 [GPS=28886.994s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.007,76.92,1504,1237,follow_path,28886994,1.692,-2.299,-0.000,169.13,169.73,3.490,-12.220*71 [GPS=28887.006s r=1] STM32 UART5 CTRL: $CTRL,0.439,-0.008,76.92,1504,1237,follow_path,28887006,1.692,-2.299,-0.000,169.12,169.73,3.490,-12.220*7C [GPS=28887.029s r=1] STM32 UART5 CTRL: $CTRL,0.440,0.010,76.92,1495,1236,follow_path,28887029,1.700,-2.343,-0.000,169.17,169.73,3.490,-12.220*5A [GPS=28887.041s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1503,1236,follow_path,28887041,1.700,-2.343,-0.000,169.16,169.73,3.490,-12.220*70 [GPS=28887.053s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.003,76.92,1501,1236,follow_path,28887053,1.700,-2.343,-0.000,169.17,169.73,3.490,-12.220*74 [GPS=28887.059s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1503,1236,follow_path,28887059,1.700,-2.343,-0.000,169.17,169.73,3.490,-12.220*78 [GPS=28887.083s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1503,1236,follow_path,28887083,1.700,-2.343,-0.000,169.16,169.73,3.490,-12.220*7E [GPS=28887.094s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1504,1236,follow_path,28887094,1.700,-2.343,-0.000,169.16,169.73,3.490,-12.220*7F [GPS=28887.106s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.008,76.92,1504,1236,follow_path,28887106,1.700,-2.343,-0.000,169.15,169.73,3.490,-12.220*79 [GPS=28887.118s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.008,76.92,1504,1236,follow_path,28887118,1.700,-2.343,-0.000,169.14,169.73,3.490,-12.220*77 [GPS=28887.124s r=1] STM32 UART5 CTRL: $CTRL,0.440,0.011,76.92,1495,1236,follow_path,28887124,1.709,-2.386,-0.000,169.19,169.73,3.490,-12.220*59 [GPS=28887.136s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.008,76.92,1504,1236,follow_path,28887136,1.709,-2.386,-0.000,169.19,169.73,3.490,-12.220*76 [GPS=28887.160s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1504,1236,follow_path,28887160,1.709,-2.386,-0.000,169.18,169.73,3.490,-12.220*7B [GPS=28887.172s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1503,1236,follow_path,28887172,1.709,-2.386,-0.000,169.18,169.73,3.490,-12.220*7F [GPS=28887.178s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1503,1236,follow_path,28887178,1.709,-2.386,-0.000,169.17,169.73,3.490,-12.220*7A [GPS=28887.190s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.007,76.92,1504,1236,follow_path,28887190,1.709,-2.386,-0.000,169.17,169.73,3.490,-12.220*7B [GPS=28887.202s r=1] STM32 UART5 CTRL: $CTRL,0.440,-0.008,76.92,1504,1236,follow_path,28887202,1.709,-2.386,-0.000,169.16,169.73,3.490,-12.220*7D [GPS=28887.214s r=1] STM32 UART5 CTRL: $CTRL,0.441,0.014,76.92,1493,1236,follow_path,28887214,1.717,-2.430,-0.000,169.22,169.73,3.490,-12.220*56 [GPS=28887.238s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.002,76.92,1501,1236,follow_path,28887238,1.717,-2.430,-0.000,169.23,169.73,3.490,-12.220*79 [GPS=28887.250s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.004,76.92,1502,1236,follow_path,28887250,1.717,-2.430,-0.000,169.23,169.73,3.490,-12.220*72 [GPS=28887.256s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.005,76.92,1503,1236,follow_path,28887256,1.717,-2.430,-0.000,169.23,169.73,3.490,-12.220*74 [GPS=28887.268s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.005,76.92,1503,1236,follow_path,28887268,1.717,-2.430,-0.000,169.23,169.73,3.490,-12.220*79 [GPS=28887.280s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.005,76.92,1503,1236,follow_path,28887280,1.717,-2.430,-0.000,169.23,169.73,3.490,-12.220*7F [GPS=28887.304s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.006,76.92,1503,1236,follow_path,28887304,1.717,-2.430,-0.000,169.22,169.73,3.490,-12.220*70 [GPS=28887.310s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.006,76.92,1503,1236,follow_path,28887310,1.717,-2.430,-0.000,169.22,169.73,3.490,-12.220*75 [GPS=28887.310s r=1] STM32 UART5 CTRL: $CTRL,0.441,0.003,76.92,1499,1236,follow_path,28887310,1.725,-2.474,0.000,169.24,169.74,3.490,-12.220*72 [GPS=28887.334s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.006,76.92,1503,1236,follow_path,28887334,1.725,-2.474,0.000,169.24,169.74,3.490,-12.220*5E [GPS=28887.346s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.003,76.92,1502,1236,follow_path,28887346,1.725,-2.474,0.000,169.24,169.74,3.490,-12.220*5F [GPS=28887.346s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.009,-0.49,28887346*2C [GPS=28887.358s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.007,76.92,1503,1236,follow_path,28887358,1.725,-2.474,0.000,169.24,169.74,3.490,-12.220*55 [GPS=28887.376s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.006,76.92,1503,1236,follow_path,28887376,1.725,-2.474,0.000,169.24,169.74,3.490,-12.220*58 [GPS=28887.388s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.007,76.92,1504,1236,follow_path,28887388,1.725,-2.474,0.000,169.23,169.74,3.490,-12.220*58 [GPS=28887.400s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.007,76.92,1503,1236,follow_path,28887400,1.725,-2.474,0.000,169.22,169.74,3.490,-12.220*59 [GPS=28887.412s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.007,76.92,1504,1236,follow_path,28887412,1.725,-2.474,0.000,169.22,169.74,3.490,-12.220*5D [GPS=28887.424s r=1] STM32 UART5 CTRL: $CTRL,0.442,0.012,76.92,1494,1235,follow_path,28887424,1.734,-2.519,0.000,169.27,169.74,3.490,-12.220*76 [GPS=28887.442s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.007,76.92,1504,1235,follow_path,28887442,1.734,-2.519,0.000,169.26,169.74,3.490,-12.220*56 [GPS=28887.454s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.001,76.92,1501,1235,follow_path,28887454,1.734,-2.519,0.000,169.27,169.74,3.490,-12.220*53 [GPS=28887.466s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887466,1.734,-2.519,0.000,169.27,169.74,3.490,-12.220*57 [GPS=28887.478s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.004,76.92,1502,1235,follow_path,28887478,1.734,-2.519,0.000,169.27,169.74,3.490,-12.220*5B [GPS=28887.490s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887490,1.734,-2.519,0.000,169.27,169.74,3.490,-12.220*5E [GPS=28887.502s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887502,1.734,-2.519,0.000,169.26,169.74,3.490,-12.220*55 [GPS=28887.520s r=1] STM32 UART5 CTRL: $CTRL,0.441,-0.006,76.92,1503,1235,follow_path,28887520,1.734,-2.519,0.000,169.26,169.74,3.490,-12.220*56 [GPS=28887.532s r=1] STM32 UART5 CTRL: $CTRL,0.442,0.004,76.92,1498,1235,follow_path,28887532,1.742,-2.560,0.000,169.29,169.74,3.490,-12.220*7A [GPS=28887.544s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887544,1.742,-2.560,0.000,169.28,169.74,3.490,-12.220*56 [GPS=28887.556s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.004,76.92,1502,1235,follow_path,28887556,1.742,-2.560,0.000,169.28,169.74,3.490,-12.220*56 [GPS=28887.568s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.007,76.92,1503,1235,follow_path,28887568,1.742,-2.560,0.000,169.28,169.74,3.490,-12.220*59 [GPS=28887.586s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887586,1.742,-2.560,0.000,169.27,169.74,3.490,-12.220*57 [GPS=28887.598s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.008,76.92,1504,1235,follow_path,28887598,1.742,-2.560,0.000,169.27,169.74,3.490,-12.220*51 [GPS=28887.610s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887610,1.742,-2.560,0.000,169.26,169.74,3.490,-12.220*5A [GPS=28887.622s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.007,76.92,1504,1235,follow_path,28887622,1.742,-2.560,0.000,169.26,169.74,3.490,-12.220*5D [GPS=28887.633s r=1] STM32 UART5 CTRL: $CTRL,0.442,0.016,76.92,1492,1235,follow_path,28887633,1.750,-2.604,0.000,169.32,169.74,3.490,-12.220*79 [GPS=28887.645s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.007,76.92,1503,1235,follow_path,28887645,1.750,-2.604,0.000,169.31,169.74,3.490,-12.220*5F [GPS=28887.663s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.000,76.92,1510,1235,follow_path,28887663,1.750,-2.604,0.000,169.32,169.74,3.490,-12.220*5D [GPS=28887.675s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887675,1.750,-2.604,0.000,169.32,169.74,3.490,-12.220*5E [GPS=28887.687s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.004,76.92,1502,1235,follow_path,28887687,1.750,-2.604,0.000,169.31,169.74,3.490,-12.220*53 [GPS=28887.699s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887699,1.750,-2.604,0.000,169.31,169.74,3.490,-12.220*5F [GPS=28887.711s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.005,76.92,1502,1235,follow_path,28887711,1.750,-2.604,0.000,169.31,169.74,3.490,-12.220*5C [GPS=28887.717s r=1] STM32 UART5 CTRL: $CTRL,0.443,0.002,76.92,1499,1235,follow_path,28887717,1.758,-2.648,0.000,169.33,169.74,3.490,-12.220*70 [GPS=28887.741s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.006,76.92,1503,1235,follow_path,28887741,1.758,-2.648,0.000,169.32,169.74,3.490,-12.220*59 [GPS=28887.753s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.004,76.92,1502,1235,follow_path,28887753,1.758,-2.648,0.000,169.32,169.74,3.490,-12.220*59 [GPS=28887.765s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.006,76.92,1503,1235,follow_path,28887765,1.758,-2.648,0.000,169.32,169.74,3.490,-12.220*5F [GPS=28887.777s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.005,76.92,1502,1235,follow_path,28887777,1.758,-2.648,0.000,169.32,169.74,3.490,-12.220*5F [GPS=28887.795s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887795,1.758,-2.648,0.000,169.31,169.74,3.490,-12.220*52 [GPS=28887.807s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.006,76.92,1503,1235,follow_path,28887807,1.758,-2.648,0.000,169.31,169.74,3.490,-12.220*56 [GPS=28887.819s r=1] STM32 UART5 CTRL: $CTRL,0.442,-0.007,76.92,1504,1235,follow_path,28887819,1.758,-2.648,0.000,169.30,169.74,3.490,-12.220*5E [GPS=28887.831s r=1] STM32 UART5 CTRL: $CTRL,0.443,0.014,76.92,1493,1235,follow_path,28887831,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*78 [GPS=28887.843s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.006,76.92,1503,1235,follow_path,28887843,1.767,-2.693,0.000,169.35,169.75,3.490,-12.220*58 [GPS=28887.849s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.000,76.92,1510,1235,follow_path,28887849,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*55 [GPS=28887.873s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.003,76.92,1502,1235,follow_path,28887873,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*5C [GPS=28887.885s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.004,76.92,1502,1235,follow_path,28887885,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*52 [GPS=28887.897s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.004,76.92,1502,1235,follow_path,28887897,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*51 [GPS=28887.903s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.004,76.92,1502,1235,follow_path,28887903,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*5D [GPS=28887.915s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1502,1235,follow_path,28887915,1.767,-2.693,0.000,169.36,169.75,3.490,-12.220*5B [GPS=28887.927s r=1] STM32 UART5 CTRL: $CTRL,0.443,0.001,76.92,1510,1235,follow_path,28887927,1.775,-2.737,0.000,169.37,169.75,3.490,-12.220*7D [GPS=28887.951s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.004,76.92,1502,1235,follow_path,28887951,1.775,-2.737,0.000,169.37,169.75,3.490,-12.220*57 [GPS=28887.963s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1502,1235,follow_path,28887963,1.775,-2.737,0.000,169.37,169.75,3.490,-12.220*57 [GPS=28887.963s r=1] STM32 UART5 POSE: $POSE,1.775,-2.737,0.000,169.37,0.00,0.59,3.490,-12.220,28887963*2A [GPS=28887.969s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1503,1235,follow_path,28887969,1.775,-2.737,0.000,169.36,169.75,3.490,-12.220*5D [GPS=28887.981s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1503,1235,follow_path,28887981,1.775,-2.737,0.000,169.36,169.75,3.490,-12.220*5B [GPS=28887.993s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.006,76.92,1503,1235,follow_path,28887993,1.775,-2.737,0.000,169.35,169.75,3.490,-12.220*58 [GPS=28888.017s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1503,1235,follow_path,28888017,1.775,-2.737,0.000,169.35,169.75,3.490,-12.220*51 [GPS=28888.017s r=1] STM32 UART5 CTRL: $CTRL,0.443,-0.005,76.92,1503,1235,follow_path,28888017,1.775,-2.737,0.000,169.35,169.75,3.490,-12.220*51 [GPS=28888.034s r=1] STM32 UART5 CTRL: $CTRL,0.444,0.011,76.92,1495,1234,follow_path,28888034,1.783,-2.779,0.000,169.39,169.75,3.490,-12.220*7F [GPS=28888.046s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.005,76.92,1502,1234,follow_path,28888046,1.783,-2.779,0.000,169.39,169.75,3.490,-12.220*5D [GPS=28888.058s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.001,76.92,1510,1234,follow_path,28888058,1.783,-2.779,0.000,169.40,169.75,3.490,-12.220*5B [GPS=28888.070s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888070,1.783,-2.779,0.000,169.39,169.75,3.490,-12.220*59 [GPS=28888.094s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.005,76.92,1503,1234,follow_path,28888094,1.783,-2.779,0.000,169.39,169.75,3.490,-12.220*53 [GPS=28888.100s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888100,1.783,-2.779,0.000,169.39,169.75,3.490,-12.220*5F [GPS=28888.112s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888112,1.783,-2.779,0.000,169.38,169.75,3.490,-12.220*5D [GPS=28888.124s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888124,1.783,-2.779,0.000,169.38,169.75,3.490,-12.220*58 [GPS=28888.136s r=1] STM32 UART5 CTRL: $CTRL,0.444,0.005,76.92,1498,1234,follow_path,28888136,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*78 [GPS=28888.160s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.002,76.92,1501,1234,follow_path,28888160,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*50 [GPS=28888.166s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.003,76.92,1501,1234,follow_path,28888166,1.791,-2.823,0.000,169.42,169.75,3.490,-12.220*54 [GPS=28888.178s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888178,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*5C [GPS=28888.190s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.003,76.92,1502,1234,follow_path,28888190,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*5D [GPS=28888.202s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888202,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*52 [GPS=28888.214s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888214,1.791,-2.823,0.000,169.41,169.75,3.490,-12.220*55 [GPS=28888.226s r=1] STM32 UART5 CTRL: $CTRL,0.444,0.002,76.92,1499,1234,follow_path,28888226,1.799,-2.867,0.000,169.42,169.75,3.490,-12.220*77 [GPS=28888.244s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888244,1.799,-2.867,0.000,169.42,169.75,3.490,-12.220*5B [GPS=28888.256s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.003,76.92,1502,1234,follow_path,28888256,1.799,-2.867,0.000,169.42,169.75,3.490,-12.220*5F [GPS=28888.268s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888268,1.799,-2.867,0.000,169.42,169.75,3.490,-12.220*55 [GPS=28888.280s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888280,1.799,-2.867,0.000,169.41,169.75,3.490,-12.220*50 [GPS=28888.304s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.005,76.92,1502,1234,follow_path,28888304,1.799,-2.867,0.000,169.41,169.75,3.490,-12.220*5C [GPS=28888.310s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.005,76.92,1503,1234,follow_path,28888310,1.799,-2.867,0.000,169.41,169.75,3.490,-12.220*58 [GPS=28888.322s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.005,76.92,1503,1234,follow_path,28888322,1.799,-2.867,0.000,169.40,169.75,3.490,-12.220*58 [GPS=28888.334s r=1] STM32 UART5 CTRL: $CTRL,0.444,0.009,76.92,1495,1234,follow_path,28888334,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*70 [GPS=28888.346s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888346,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*5A [GPS=28888.346s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.006,-0.32,28888346*20 [GPS=28888.358s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.001,76.92,1510,1234,follow_path,28888358,1.808,-2.912,0.000,169.45,169.75,3.490,-12.220*52 [GPS=28888.376s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888376,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*59 [GPS=28888.387s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888387,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*57 [GPS=28888.399s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888399,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*58 [GPS=28888.411s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888411,1.808,-2.912,0.000,169.44,169.75,3.490,-12.220*5F [GPS=28888.422s r=1] STM32 UART5 CTRL: $CTRL,0.444,-0.004,76.92,1502,1234,follow_path,28888422,1.808,-2.912,0.000,169.43,169.75,3.490,-12.220*58 [GPS=28888.434s r=1] STM32 UART5 CTRL: $CTRL,0.445,0.004,76.92,1498,1234,follow_path,28888434,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*7B [GPS=28888.452s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888452,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*54 [GPS=28888.464s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.002,76.92,1501,1234,follow_path,28888464,1.816,-2.956,0.000,169.46,169.76,3.490,-12.220*57 [GPS=28888.476s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888476,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*52 [GPS=28888.488s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888488,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*53 [GPS=28888.500s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888500,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*52 [GPS=28888.518s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888518,1.816,-2.956,0.000,169.45,169.76,3.490,-12.220*5B [GPS=28888.518s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888518,1.816,-2.956,0.000,169.44,169.76,3.490,-12.220*5A [GPS=28888.542s r=1] STM32 UART5 CTRL: $CTRL,0.445,0.005,76.92,1497,1234,follow_path,28888542,1.824,-3.000,-0.000,169.47,169.76,3.490,-12.220*50 [GPS=28888.554s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.003,76.92,1502,1234,follow_path,28888554,1.824,-3.000,-0.000,169.47,169.76,3.490,-12.220*71 [GPS=28888.566s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.002,76.92,1501,1234,follow_path,28888566,1.824,-3.000,-0.000,169.47,169.76,3.490,-12.220*72 [GPS=28888.578s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888578,1.824,-3.000,-0.000,169.47,169.76,3.490,-12.220*78 [GPS=28888.596s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.003,76.92,1502,1234,follow_path,28888596,1.824,-3.000,-0.000,169.47,169.76,3.490,-12.220*7F [GPS=28888.608s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888608,1.824,-3.000,-0.000,169.46,169.76,3.490,-12.220*7D [GPS=28888.620s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1502,1234,follow_path,28888620,1.824,-3.000,-0.000,169.46,169.76,3.490,-12.220*76 [GPS=28888.620s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1503,1234,follow_path,28888620,1.824,-3.000,-0.000,169.45,169.76,3.490,-12.220*74 [GPS=28888.638s r=1] STM32 UART5 CTRL: $CTRL,0.445,0.007,76.92,1497,1234,follow_path,28888638,1.832,-3.045,-0.000,169.48,169.76,3.490,-12.220*55 [GPS=28888.662s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.000,76.92,1510,1234,follow_path,28888662,1.832,-3.045,-0.000,169.49,169.76,3.490,-12.220*7F [GPS=28888.673s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.001,76.92,1510,1234,follow_path,28888673,1.832,-3.045,-0.000,169.50,169.76,3.490,-12.220*76 [GPS=28888.685s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.002,76.92,1501,1234,follow_path,28888685,1.832,-3.045,-0.000,169.50,169.76,3.490,-12.220*7C [GPS=28888.697s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.002,76.92,1501,1234,follow_path,28888697,1.832,-3.045,-0.000,169.50,169.76,3.490,-12.220*7F [GPS=28888.709s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.003,76.92,1502,1234,follow_path,28888709,1.832,-3.045,-0.000,169.49,169.76,3.490,-12.220*73 [GPS=28888.721s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.003,76.92,1502,1234,follow_path,28888721,1.832,-3.045,-0.000,169.49,169.76,3.490,-12.220*79 [GPS=28888.727s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.003,76.92,1501,1234,follow_path,28888727,1.841,-3.089,-0.000,169.49,169.76,3.490,-12.220*78 [GPS=28888.750s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888750,1.841,-3.089,-0.000,169.49,169.76,3.490,-12.220*7C [GPS=28888.762s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1502,1234,follow_path,28888762,1.841,-3.089,-0.000,169.48,169.76,3.490,-12.220*7D [GPS=28888.774s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1502,1234,follow_path,28888774,1.841,-3.089,-0.000,169.48,169.76,3.490,-12.220*7A [GPS=28888.786s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.004,76.92,1502,1234,follow_path,28888786,1.841,-3.089,-0.000,169.48,169.76,3.490,-12.220*76 [GPS=28888.804s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1503,1234,follow_path,28888804,1.841,-3.089,-0.000,169.47,169.76,3.490,-12.220*7C [GPS=28888.816s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1502,1234,follow_path,28888816,1.841,-3.089,-0.000,169.47,169.76,3.490,-12.220*7E [GPS=28888.828s r=1] STM32 UART5 CTRL: $CTRL,0.445,-0.005,76.92,1502,1234,follow_path,28888828,1.841,-3.089,-0.000,169.46,169.76,3.490,-12.220*72 [GPS=28888.840s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.015,76.92,1493,1233,follow_path,28888840,1.848,-3.131,-0.000,169.51,169.76,3.490,-12.220*50 [GPS=28888.846s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28888846,1.848,-3.131,-0.000,169.51,169.76,3.490,-12.220*75 [GPS=28888.858s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.001,76.92,1510,1233,follow_path,28888858,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*55 [GPS=28888.882s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28888882,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*7C [GPS=28888.894s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28888894,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*7B [GPS=28888.906s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28888906,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*73 [GPS=28888.912s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28888912,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*74 [GPS=28888.924s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28888924,1.848,-3.131,-0.000,169.52,169.76,3.490,-12.220*73 [GPS=28888.936s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28888936,1.857,-3.175,-0.000,169.52,169.76,3.490,-12.220*7D [GPS=28888.960s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28888960,1.857,-3.175,-0.000,169.52,169.76,3.490,-12.220*7D [GPS=28888.960s r=1] STM32 UART5 POSE: $POSE,1.857,-3.175,-0.000,169.52,0.00,0.45,3.490,-12.220,28888960*0B [GPS=28888.972s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28888972,1.857,-3.175,-0.000,169.51,169.76,3.490,-12.220*7A [GPS=28888.978s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28888978,1.857,-3.175,-0.000,169.51,169.76,3.490,-12.220*74 [GPS=28888.990s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28888990,1.857,-3.175,-0.000,169.51,169.76,3.490,-12.220*71 [GPS=28889.002s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28889002,1.857,-3.175,-0.000,169.51,169.76,3.490,-12.220*75 [GPS=28889.026s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28889026,1.857,-3.175,-0.000,169.50,169.76,3.490,-12.220*72 [GPS=28889.026s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28889026,1.857,-3.175,-0.000,169.50,169.76,3.490,-12.220*72 [GPS=28889.044s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.009,76.92,1496,1233,follow_path,28889044,1.865,-3.220,-0.000,169.54,169.76,3.490,-12.220*5C [GPS=28889.056s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889056,1.865,-3.220,-0.000,169.53,169.76,3.490,-12.220*73 [GPS=28889.068s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.001,76.92,1510,1233,follow_path,28889068,1.865,-3.220,-0.000,169.54,169.76,3.490,-12.220*55 [GPS=28889.092s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889092,1.865,-3.220,-0.000,169.54,169.76,3.490,-12.220*7E [GPS=28889.104s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28889104,1.865,-3.220,-0.000,169.54,169.76,3.490,-12.220*75 [GPS=28889.110s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28889110,1.865,-3.220,-0.000,169.54,169.76,3.490,-12.220*74 [GPS=28889.122s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889122,1.865,-3.220,-0.000,169.53,169.76,3.490,-12.220*71 [GPS=28889.122s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.001,76.92,1499,1233,follow_path,28889122,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*5C [GPS=28889.146s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889146,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*72 [GPS=28889.170s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889170,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*77 [GPS=28889.176s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889176,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*73 [GPS=28889.188s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889188,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*70 [GPS=28889.200s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28889200,1.873,-3.265,-0.000,169.54,169.76,3.490,-12.220*70 [GPS=28889.212s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.004,76.92,1502,1233,follow_path,28889212,1.873,-3.265,-0.000,169.53,169.76,3.490,-12.220*70 [GPS=28889.224s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889224,1.873,-3.265,-0.000,169.53,169.76,3.490,-12.220*72 [GPS=28889.236s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.006,76.92,1497,1233,follow_path,28889236,1.881,-3.309,-0.000,169.56,169.77,3.490,-12.220*56 [GPS=28889.254s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28889254,1.881,-3.309,-0.000,169.55,169.77,3.490,-12.220*77 [GPS=28889.266s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.001,76.92,1510,1233,follow_path,28889266,1.881,-3.309,-0.000,169.56,169.77,3.490,-12.220*77 [GPS=28889.278s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889278,1.881,-3.309,-0.000,169.56,169.77,3.490,-12.220*7B [GPS=28889.290s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889290,1.881,-3.309,-0.000,169.56,169.77,3.490,-12.220*7D [GPS=28889.308s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889308,1.881,-3.309,-0.000,169.56,169.77,3.490,-12.220*7F [GPS=28889.320s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889320,1.881,-3.309,-0.000,169.55,169.77,3.490,-12.220*76 [GPS=28889.332s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889332,1.881,-3.309,-0.000,169.55,169.77,3.490,-12.220*75 [GPS=28889.344s r=1] STM32 UART5 CTRL: $CTRL,0.446,0.003,76.92,1499,1233,follow_path,28889344,1.890,-3.354,-0.000,169.57,169.77,3.490,-12.220*50 [GPS=28889.344s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.004,-0.20,28889344*22 [GPS=28889.356s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1502,1233,follow_path,28889356,1.890,-3.354,-0.000,169.56,169.77,3.490,-12.220*7C [GPS=28889.368s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.001,76.92,1510,1233,follow_path,28889368,1.890,-3.354,-0.000,169.57,169.77,3.490,-12.220*71 [GPS=28889.386s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.003,76.92,1501,1233,follow_path,28889386,1.890,-3.354,-0.000,169.57,169.77,3.490,-12.220*73 [GPS=28889.398s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889398,1.890,-3.354,-0.000,169.57,169.77,3.490,-12.220*7D [GPS=28889.410s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889410,1.890,-3.354,-0.000,169.57,169.77,3.490,-12.220*7A [GPS=28889.421s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889421,1.890,-3.354,-0.000,169.56,169.77,3.490,-12.220*79 [GPS=28889.433s r=1] STM32 UART5 CTRL: $CTRL,0.446,-0.002,76.92,1501,1233,follow_path,28889433,1.890,-3.354,-0.000,169.56,169.77,3.490,-12.220*7A [GPS=28889.445s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.001,76.92,1499,1233,follow_path,28889445,1.897,-3.396,0.000,169.58,169.77,3.490,-12.220*7E [GPS=28889.463s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889463,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*5B [GPS=28889.475s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889475,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*5C [GPS=28889.487s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28889487,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*50 [GPS=28889.499s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889499,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*5E [GPS=28889.505s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.004,76.92,1502,1233,follow_path,28889505,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*5F [GPS=28889.529s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889529,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*54 [GPS=28889.529s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889529,1.897,-3.396,0.000,169.57,169.77,3.490,-12.220*54 [GPS=28889.553s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.004,76.92,1498,1233,follow_path,28889553,1.905,-3.441,0.000,169.59,169.77,3.490,-12.220*7A [GPS=28889.565s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28889565,1.905,-3.441,0.000,169.58,169.77,3.490,-12.220*55 [GPS=28889.571s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1501,1233,follow_path,28889571,1.905,-3.441,0.000,169.59,169.77,3.490,-12.220*53 [GPS=28889.583s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1502,1233,follow_path,28889583,1.905,-3.441,0.000,169.58,169.77,3.490,-12.220*5E [GPS=28889.607s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889607,1.905,-3.441,0.000,169.58,169.77,3.490,-12.220*53 [GPS=28889.619s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1502,1233,follow_path,28889619,1.905,-3.441,0.000,169.58,169.77,3.490,-12.220*5E [GPS=28889.631s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889631,1.905,-3.441,0.000,169.58,169.77,3.490,-12.220*56 [GPS=28889.642s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.003,76.92,1498,1233,follow_path,28889642,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*76 [GPS=28889.655s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889655,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*5D [GPS=28889.672s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889672,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*58 [GPS=28889.685s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28889685,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*51 [GPS=28889.696s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889696,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*52 [GPS=28889.708s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28889708,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*55 [GPS=28889.714s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28889714,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*58 [GPS=28889.726s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889726,1.914,-3.485,0.000,169.59,169.77,3.490,-12.220*58 [GPS=28889.750s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.004,76.92,1498,1233,follow_path,28889750,1.922,-3.530,0.000,169.60,169.77,3.490,-12.220*73 [GPS=28889.762s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889762,1.922,-3.530,0.000,169.60,169.77,3.490,-12.220*58 [GPS=28889.774s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1510,1233,follow_path,28889774,1.922,-3.530,0.000,169.61,169.77,3.490,-12.220*5D [GPS=28889.786s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889786,1.922,-3.530,0.000,169.61,169.77,3.490,-12.220*53 [GPS=28889.792s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889792,1.922,-3.530,0.000,169.61,169.77,3.490,-12.220*56 [GPS=28889.804s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889804,1.922,-3.530,0.000,169.60,169.77,3.490,-12.220*57 [GPS=28889.828s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1501,1233,follow_path,28889828,1.922,-3.530,0.000,169.61,169.77,3.490,-12.220*5B [GPS=28889.840s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1502,1233,follow_path,28889840,1.922,-3.530,0.000,169.60,169.77,3.490,-12.220*55 [GPS=28889.852s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.001,76.92,1499,1233,follow_path,28889852,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*79 [GPS=28889.858s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1501,1233,follow_path,28889858,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*5E [GPS=28889.870s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1501,1233,follow_path,28889870,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*54 [GPS=28889.894s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889894,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*5D [GPS=28889.906s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889906,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*57 [GPS=28889.918s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889918,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*58 [GPS=28889.924s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28889924,1.930,-3.575,0.000,169.61,169.77,3.490,-12.220*57 [GPS=28889.936s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.002,76.92,1499,1232,follow_path,28889936,1.938,-3.619,0.000,169.62,169.77,3.490,-12.220*7A [GPS=28889.948s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28889948,1.938,-3.619,0.000,169.62,169.77,3.490,-12.220*5E [GPS=28889.948s r=1] STM32 UART5 POSE: $POSE,1.938,-3.619,0.000,169.62,0.00,0.30,3.490,-12.220,28889948*29 [GPS=28889.972s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28889972,1.938,-3.619,0.000,169.62,169.77,3.490,-12.220*57 [GPS=28889.984s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28889984,1.938,-3.619,0.000,169.62,169.77,3.490,-12.220*5E [GPS=28889.990s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28889990,1.938,-3.619,0.000,169.62,169.77,3.490,-12.220*5B [GPS=28890.002s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28890002,1.938,-3.619,0.000,169.61,169.77,3.490,-12.220*52 [GPS=28890.014s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1233,follow_path,28890014,1.938,-3.619,0.000,169.61,169.77,3.490,-12.220*54 [GPS=28890.037s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1233,follow_path,28890037,1.938,-3.619,0.000,169.61,169.77,3.490,-12.220*54 [GPS=28890.037s r=1] STM32 UART5 CTRL: $CTRL,0.447,0.005,76.92,1498,1232,follow_path,28890037,1.946,-3.661,0.000,169.63,169.77,3.490,-12.220*7B [GPS=28890.055s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1232,follow_path,28890055,1.946,-3.661,0.000,169.63,169.77,3.490,-12.220*55 [GPS=28890.067s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.001,76.92,1510,1232,follow_path,28890067,1.946,-3.661,0.000,169.63,169.77,3.490,-12.220*56 [GPS=28890.079s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28890079,1.946,-3.661,0.000,169.63,169.77,3.490,-12.220*5A [GPS=28890.103s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1232,follow_path,28890103,1.946,-3.661,0.000,169.62,169.77,3.490,-12.220*56 [GPS=28890.115s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1502,1232,follow_path,28890115,1.946,-3.661,0.000,169.62,169.77,3.490,-12.220*52 [GPS=28890.121s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.003,76.92,1501,1232,follow_path,28890121,1.946,-3.661,0.000,169.62,169.77,3.490,-12.220*56 [GPS=28890.133s r=1] STM32 UART5 CTRL: $CTRL,0.447,-0.002,76.92,1501,1232,follow_path,28890133,1.946,-3.661,0.000,169.62,169.77,3.490,-12.220*54 [GPS=28890.145s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.006,76.92,1497,1232,follow_path,28890145,1.954,-3.706,0.000,169.64,169.77,3.490,-12.220*78 [GPS=28890.157s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890157,1.954,-3.706,0.000,169.64,169.77,3.490,-12.220*5F [GPS=28890.180s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890180,1.954,-3.706,0.000,169.64,169.77,3.490,-12.220*56 [GPS=28890.186s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890186,1.954,-3.706,0.000,169.63,169.77,3.490,-12.220*57 [GPS=28890.198s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890198,1.954,-3.706,0.000,169.63,169.77,3.490,-12.220*58 [GPS=28890.210s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890210,1.954,-3.706,0.000,169.63,169.77,3.490,-12.220*5B [GPS=28890.222s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890222,1.954,-3.706,0.000,169.63,169.77,3.490,-12.220*5A [GPS=28890.234s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890234,1.954,-3.706,0.000,169.63,169.77,3.490,-12.220*5C [GPS=28890.252s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.003,76.92,1499,1232,follow_path,28890252,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*71 [GPS=28890.264s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890264,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*58 [GPS=28890.276s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890276,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*58 [GPS=28890.288s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890288,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*5B [GPS=28890.300s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890300,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*5B [GPS=28890.318s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890318,1.962,-3.751,0.000,169.64,169.77,3.490,-12.220*52 [GPS=28890.330s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890330,1.962,-3.751,0.000,169.63,169.77,3.490,-12.220*5E [GPS=28890.330s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.004,76.92,1498,1232,follow_path,28890330,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*59 [GPS=28890.330s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.002,-0.13,28890330*2F [GPS=28890.354s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890354,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*71 [GPS=28890.366s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1510,1232,follow_path,28890366,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*73 [GPS=28890.372s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890372,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*75 [GPS=28890.396s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890396,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*7F [GPS=28890.408s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890408,1.970,-3.796,-0.000,169.65,169.78,3.490,-12.220*7F [GPS=28890.419s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890419,1.970,-3.796,-0.000,169.64,169.78,3.490,-12.220*7F [GPS=28890.431s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890431,1.970,-3.796,-0.000,169.64,169.78,3.490,-12.220*74 [GPS=28890.437s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.004,76.92,1498,1232,follow_path,28890437,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*57 [GPS=28890.461s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890461,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*7D [GPS=28890.473s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.001,76.92,1510,1232,follow_path,28890473,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*53 [GPS=28890.485s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890485,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*77 [GPS=28890.497s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1510,1232,follow_path,28890497,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*74 [GPS=28890.503s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890503,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*7B [GPS=28890.515s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890515,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*7F [GPS=28890.539s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890539,1.979,-3.840,-0.000,169.66,169.78,3.490,-12.220*72 [GPS=28890.551s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1510,1232,follow_path,28890551,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*77 [GPS=28890.563s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890563,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*75 [GPS=28890.569s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890569,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*7C [GPS=28890.581s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890581,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*79 [GPS=28890.605s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890605,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*75 [GPS=28890.617s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890617,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*74 [GPS=28890.629s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890629,1.987,-3.885,-0.000,169.66,169.78,3.490,-12.220*7B [GPS=28890.635s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890635,1.987,-3.885,-0.000,169.65,169.78,3.490,-12.220*76 [GPS=28890.647s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.005,76.92,1497,1232,follow_path,28890647,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*59 [GPS=28890.671s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.000,76.92,1510,1232,follow_path,28890671,1.995,-3.930,-0.000,169.68,169.78,3.490,-12.220*58 [GPS=28890.683s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890683,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*75 [GPS=28890.695s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890695,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*72 [GPS=28890.701s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890701,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*7D [GPS=28890.713s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890713,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*7D [GPS=28890.725s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890725,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*7B [GPS=28890.737s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890737,1.995,-3.930,-0.000,169.67,169.78,3.490,-12.220*78 [GPS=28890.761s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.001,76.92,1499,1232,follow_path,28890761,2.003,-3.972,-0.000,169.67,169.78,3.490,-12.220*55 [GPS=28890.773s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890773,2.003,-3.972,-0.000,169.67,169.78,3.490,-12.220*78 [GPS=28890.779s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890779,2.003,-3.972,-0.000,169.67,169.78,3.490,-12.220*71 [GPS=28890.791s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890791,2.003,-3.972,-0.000,169.67,169.78,3.490,-12.220*75 [GPS=28890.803s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890803,2.003,-3.972,-0.000,169.67,169.78,3.490,-12.220*73 [GPS=28890.827s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890827,2.003,-3.972,-0.000,169.66,169.78,3.490,-12.220*77 [GPS=28890.838s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.003,76.92,1501,1232,follow_path,28890838,2.003,-3.972,-0.000,169.66,169.78,3.490,-12.220*78 [GPS=28890.838s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.005,76.92,1497,1232,follow_path,28890838,2.011,-4.017,-0.000,169.68,169.78,3.490,-12.220*5D [GPS=28890.856s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890856,2.011,-4.017,-0.000,169.68,169.78,3.490,-12.220*71 [GPS=28890.868s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.001,76.92,1510,1232,follow_path,28890868,2.011,-4.017,-0.000,169.68,169.78,3.490,-12.220*52 [GPS=28890.892s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.000,76.92,1510,1232,follow_path,28890892,2.011,-4.017,-0.000,169.68,169.78,3.490,-12.220*7B [GPS=28890.904s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.000,76.92,1510,1232,follow_path,28890904,2.011,-4.017,-0.000,169.69,169.78,3.490,-12.220*74 [GPS=28890.910s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.000,76.92,1510,1232,follow_path,28890910,2.011,-4.017,-0.000,169.69,169.78,3.490,-12.220*71 [GPS=28890.922s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.000,76.92,1510,1232,follow_path,28890922,2.011,-4.017,-0.000,169.69,169.78,3.490,-12.220*70 [GPS=28890.933s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890933,2.011,-4.017,-0.000,169.69,169.78,3.490,-12.220*71 [GPS=28890.944s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890944,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*78 [GPS=28890.944s r=1] STM32 UART5 POSE: $POSE,2.019,-4.063,-0.000,169.68,0.00,-0.00,3.490,-12.220,28890944*21 [GPS=28890.967s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890967,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*7A [GPS=28890.979s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28890979,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*76 [GPS=28890.985s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890985,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*76 [GPS=28890.997s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28890997,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*75 [GPS=28891.020s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891020,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*71 [GPS=28891.032s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891032,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*72 [GPS=28891.038s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891038,2.019,-4.063,-0.000,169.68,169.78,3.490,-12.220*78 [GPS=28891.050s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.003,76.92,1499,1232,follow_path,28891050,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*74 [GPS=28891.062s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891062,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*5A [GPS=28891.074s r=1] STM32 UART5 CTRL: $CTRL,0.448,0.000,76.92,1510,1232,follow_path,28891074,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*71 [GPS=28891.098s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891098,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*5F [GPS=28891.110s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.001,76.92,1501,1232,follow_path,28891110,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*5E [GPS=28891.116s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.000,76.92,1510,1232,follow_path,28891116,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*59 [GPS=28891.128s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891128,2.027,-4.108,0.000,169.69,169.78,3.490,-12.220*55 [GPS=28891.140s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891140,2.027,-4.108,0.000,169.70,169.78,3.490,-12.220*52 [GPS=28891.164s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891164,2.035,-4.153,0.000,169.69,169.78,3.490,-12.220*52 [GPS=28891.170s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891170,2.035,-4.153,0.000,169.69,169.78,3.490,-12.220*54 [GPS=28891.182s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891182,2.035,-4.153,0.000,169.69,169.78,3.490,-12.220*5B [GPS=28891.194s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891194,2.035,-4.153,0.000,169.69,169.78,3.490,-12.220*5C [GPS=28891.205s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891205,2.035,-4.153,0.000,169.69,169.78,3.490,-12.220*57 [GPS=28891.227s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891227,2.035,-4.153,0.000,169.68,169.78,3.490,-12.220*56 [GPS=28891.239s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891239,2.035,-4.153,0.000,169.68,169.78,3.490,-12.220*59 [GPS=28891.245s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891245,2.035,-4.153,0.000,169.68,169.78,3.490,-12.220*52 [GPS=28891.257s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.006,76.92,1497,1232,follow_path,28891257,2.043,-4.196,0.000,169.70,169.78,3.490,-12.220*76 [GPS=28891.269s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891269,2.043,-4.196,0.000,169.70,169.78,3.490,-12.220*5F [GPS=28891.293s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891293,2.043,-4.196,0.000,169.70,169.78,3.490,-12.220*59 [GPS=28891.305s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891305,2.043,-4.196,0.000,169.69,169.78,3.490,-12.220*5F [GPS=28891.311s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891311,2.043,-4.196,0.000,169.69,169.78,3.490,-12.220*59 [GPS=28891.323s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891323,2.043,-4.196,0.000,169.69,169.78,3.490,-12.220*5B [GPS=28891.335s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891335,2.043,-4.196,0.000,169.69,169.78,3.490,-12.220*5F [GPS=28891.335s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.001,-0.09,28891335*23 [GPS=28891.347s r=1] STM32 UART5 CTRL: $CTRL,0.448,-0.002,76.92,1501,1232,follow_path,28891347,2.043,-4.196,0.000,169.69,169.78,3.490,-12.220*58 [GPS=28891.371s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.005,76.92,1498,1232,follow_path,28891371,2.052,-4.241,0.000,169.70,169.78,3.490,-12.220*76 [GPS=28891.377s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891377,2.052,-4.241,0.000,169.70,169.78,3.490,-12.220*5B [GPS=28891.389s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28891389,2.052,-4.241,0.000,169.70,169.78,3.490,-12.220*75 [GPS=28891.400s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891400,2.052,-4.241,0.000,169.70,169.78,3.490,-12.220*5C [GPS=28891.412s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28891412,2.052,-4.241,0.000,169.70,169.78,3.490,-12.220*70 [GPS=28891.436s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891436,2.052,-4.241,0.000,169.71,169.78,3.490,-12.220*5B [GPS=28891.447s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891447,2.052,-4.241,0.000,169.71,169.78,3.490,-12.220*5C [GPS=28891.453s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891453,2.060,-4.286,0.000,169.71,169.78,3.490,-12.220*53 [GPS=28891.465s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891465,2.060,-4.286,0.000,169.71,169.78,3.490,-12.220*57 [GPS=28891.477s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891477,2.060,-4.286,0.000,169.71,169.78,3.490,-12.220*54 [GPS=28891.500s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891500,2.060,-4.286,0.000,169.71,169.78,3.490,-12.220*55 [GPS=28891.512s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891512,2.060,-4.286,0.000,169.70,169.78,3.490,-12.220*54 [GPS=28891.517s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891517,2.060,-4.286,0.000,169.70,169.78,3.490,-12.220*51 [GPS=28891.529s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891529,2.060,-4.286,0.000,169.70,169.78,3.490,-12.220*5F [GPS=28891.541s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891541,2.060,-4.286,0.000,169.70,169.78,3.490,-12.220*52 [GPS=28891.552s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.004,76.92,1498,1232,follow_path,28891552,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*77 [GPS=28891.570s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891570,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*5E [GPS=28891.582s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28891582,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*7F [GPS=28891.594s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891594,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*54 [GPS=28891.606s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891606,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*5C [GPS=28891.630s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891630,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*59 [GPS=28891.636s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891636,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*5F [GPS=28891.648s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891648,2.068,-4.329,0.000,169.71,169.78,3.490,-12.220*56 [GPS=28891.660s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891660,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*5B [GPS=28891.672s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28891672,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*74 [GPS=28891.684s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891684,2.076,-4.374,0.000,169.72,169.78,3.490,-12.220*53 [GPS=28891.702s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891702,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*5E [GPS=28891.714s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891714,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*59 [GPS=28891.726s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891726,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*58 [GPS=28891.738s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891738,2.076,-4.374,0.000,169.71,169.78,3.490,-12.220*57 [GPS=28891.750s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1232,follow_path,28891750,2.084,-4.419,0.000,169.72,169.78,3.490,-12.220*76 [GPS=28891.768s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891768,2.084,-4.419,0.000,169.72,169.78,3.490,-12.220*53 [GPS=28891.780s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28891780,2.084,-4.419,0.000,169.72,169.78,3.490,-12.220*7A [GPS=28891.791s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891791,2.084,-4.419,0.000,169.72,169.78,3.490,-12.220*56 [GPS=28891.803s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891803,2.084,-4.419,0.000,169.72,169.78,3.490,-12.220*52 [GPS=28891.821s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891821,2.084,-4.419,0.000,169.71,169.78,3.490,-12.220*52 [GPS=28891.833s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891833,2.084,-4.419,0.000,169.71,169.78,3.490,-12.220*52 [GPS=28891.845s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891845,2.084,-4.419,0.000,169.71,169.78,3.490,-12.220*53 [GPS=28891.845s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.002,76.92,1499,1232,follow_path,28891845,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*5E [GPS=28891.869s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28891869,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*7E [GPS=28891.881s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891881,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*78 [GPS=28891.899s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891899,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*70 [GPS=28891.911s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891911,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*73 [GPS=28891.923s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28891923,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*70 [GPS=28891.935s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891935,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*76 [GPS=28891.947s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891947,2.092,-4.464,-0.000,169.72,169.78,3.490,-12.220*73 [GPS=28891.947s r=1] STM32 UART5 POSE: $POSE,2.092,-4.464,-0.000,169.72,0.00,0.15,3.490,-12.220,28891947*01 [GPS=28891.947s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1500,1232,follow_path,28891947,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*50 [GPS=28891.977s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28891977,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*7C [GPS=28891.989s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28891989,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*7E [GPS=28892.001s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892001,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*74 [GPS=28892.013s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892013,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*77 [GPS=28892.018s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892018,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*7C [GPS=28892.041s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892041,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*70 [GPS=28892.053s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892053,2.100,-4.506,-0.000,169.72,169.78,3.490,-12.220*73 [GPS=28892.065s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.003,76.92,1498,1232,follow_path,28892065,2.108,-4.553,-0.000,169.73,169.78,3.490,-12.220*51 [GPS=28892.077s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892077,2.108,-4.553,-0.000,169.73,169.78,3.490,-12.220*7C [GPS=28892.089s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28892089,2.108,-4.553,-0.000,169.73,169.78,3.490,-12.220*7C [GPS=28892.107s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892107,2.108,-4.553,-0.000,169.73,169.78,3.490,-12.220*7A [GPS=28892.119s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892119,2.108,-4.553,-0.000,169.73,169.78,3.490,-12.220*75 [GPS=28892.131s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28892131,2.108,-4.553,-0.000,169.72,169.78,3.490,-12.220*7D [GPS=28892.143s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892143,2.108,-4.553,-0.000,169.72,169.78,3.490,-12.220*7B [GPS=28892.155s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892155,2.108,-4.553,-0.000,169.72,169.78,3.490,-12.220*7C [GPS=28892.167s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.003,76.92,1499,1232,follow_path,28892167,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*5B [GPS=28892.185s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892185,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*78 [GPS=28892.197s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28892197,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*57 [GPS=28892.209s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892209,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*7F [GPS=28892.221s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892221,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*75 [GPS=28892.233s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892233,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*76 [GPS=28892.250s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892250,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*73 [GPS=28892.250s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892250,2.116,-4.598,-0.000,169.73,169.78,3.490,-12.220*73 [GPS=28892.273s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1232,follow_path,28892273,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*5F [GPS=28892.284s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892284,2.124,-4.640,-0.000,169.73,169.78,3.490,-12.220*7D [GPS=28892.295s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1232,follow_path,28892295,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*57 [GPS=28892.313s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892313,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*75 [GPS=28892.325s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28892325,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*5C [GPS=28892.337s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892337,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*73 [GPS=28892.337s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.001,-0.05,28892337*2E [GPS=28892.349s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1232,follow_path,28892349,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*56 [GPS=28892.361s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28892361,2.124,-4.640,-0.000,169.74,169.78,3.490,-12.220*71 [GPS=28892.367s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28892367,2.132,-4.687,-0.000,169.74,169.78,3.490,-12.220*79 [GPS=28892.391s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892391,2.132,-4.687,-0.000,169.74,169.78,3.490,-12.220*73 [GPS=28892.403s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892403,2.132,-4.687,-0.000,169.73,169.78,3.490,-12.220*78 [GPS=28892.415s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892415,2.132,-4.687,-0.000,169.73,169.78,3.490,-12.220*7F [GPS=28892.427s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892427,2.132,-4.687,-0.000,169.73,169.78,3.490,-12.220*7E [GPS=28892.432s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892432,2.132,-4.687,-0.000,169.73,169.78,3.490,-12.220*7A [GPS=28892.444s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892444,2.132,-4.687,-0.000,169.73,169.78,3.490,-12.220*7B [GPS=28892.468s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.002,76.92,1499,1232,follow_path,28892468,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*78 [GPS=28892.480s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892480,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*50 [GPS=28892.492s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1231,follow_path,28892492,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*7D [GPS=28892.504s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1232,follow_path,28892504,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*5E [GPS=28892.522s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28892522,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*58 [GPS=28892.533s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892533,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*59 [GPS=28892.545s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1232,follow_path,28892545,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*59 [GPS=28892.556s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1232,follow_path,28892556,2.140,-4.731,0.000,169.74,169.78,3.490,-12.220*5A [GPS=28892.568s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1231,follow_path,28892568,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*72 [GPS=28892.586s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1232,follow_path,28892586,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*5C [GPS=28892.598s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1231,follow_path,28892598,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*7C [GPS=28892.610s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892610,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*52 [GPS=28892.622s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892622,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*53 [GPS=28892.634s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892634,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*54 [GPS=28892.640s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892640,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*57 [GPS=28892.652s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892652,2.148,-4.776,0.000,169.74,169.78,3.490,-12.220*54 [GPS=28892.676s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1231,follow_path,28892676,2.157,-4.821,0.000,169.75,169.78,3.490,-12.220*7D [GPS=28892.687s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892687,2.157,-4.821,0.000,169.75,169.78,3.490,-12.220*5E [GPS=28892.699s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892699,2.157,-4.821,0.000,169.74,169.78,3.490,-12.220*51 [GPS=28892.711s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892711,2.157,-4.821,0.000,169.75,169.78,3.490,-12.220*50 [GPS=28892.723s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892723,2.157,-4.821,0.000,169.74,169.78,3.490,-12.220*51 [GPS=28892.741s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892741,2.157,-4.821,0.000,169.74,169.78,3.490,-12.220*55 [GPS=28892.753s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892753,2.157,-4.821,0.000,169.74,169.78,3.490,-12.220*56 [GPS=28892.753s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1231,follow_path,28892753,2.165,-4.865,0.000,169.75,169.78,3.490,-12.220*7B [GPS=28892.776s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1231,follow_path,28892776,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*53 [GPS=28892.782s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892782,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*5A [GPS=28892.806s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892806,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*58 [GPS=28892.818s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892818,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*57 [GPS=28892.830s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28892830,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*5D [GPS=28892.842s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892842,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*59 [GPS=28892.854s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28892854,2.165,-4.865,0.000,169.74,169.78,3.490,-12.220*5F [GPS=28892.860s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.003,76.92,1499,1231,follow_path,28892860,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*73 [GPS=28892.884s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892884,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*56 [GPS=28892.896s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1231,follow_path,28892896,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*78 [GPS=28892.908s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892908,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*53 [GPS=28892.914s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892914,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*5F [GPS=28892.926s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892926,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*5F [GPS=28892.949s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892949,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*56 [GPS=28892.949s r=1] STM32 UART5 POSE: $POSE,2.173,-4.910,0.000,169.75,0.00,-0.00,3.490,-12.220,28892949*0F [GPS=28892.949s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28892949,2.173,-4.910,0.000,169.75,169.79,3.490,-12.220*56 [GPS=28892.972s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1510,1231,follow_path,28892972,2.181,-4.954,0.000,169.75,169.79,3.490,-12.220*7E [GPS=28892.984s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28892984,2.181,-4.954,0.000,169.75,169.79,3.490,-12.220*5A [GPS=28892.995s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28892995,2.181,-4.954,0.000,169.75,169.79,3.490,-12.220*5B [GPS=28893.012s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893012,2.181,-4.954,0.000,169.75,169.79,3.490,-12.220*5D [GPS=28893.024s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893024,2.181,-4.954,0.000,169.75,169.79,3.490,-12.220*58 [GPS=28893.036s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893036,2.181,-4.954,0.000,169.74,169.79,3.490,-12.220*5A [GPS=28893.048s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893048,2.181,-4.954,0.000,169.74,169.79,3.490,-12.220*53 [GPS=28893.060s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1231,follow_path,28893060,2.181,-4.954,0.000,169.74,169.79,3.490,-12.220*5A [GPS=28893.078s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.004,76.92,1498,1231,follow_path,28893078,2.189,-4.998,0.000,169.75,169.79,3.490,-12.220*70 [GPS=28893.090s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893090,2.189,-4.998,0.000,169.75,169.79,3.490,-12.220*5F [GPS=28893.102s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.001,76.92,1499,1231,follow_path,28893102,2.189,-4.998,0.000,169.76,169.79,3.490,-12.220*7B [GPS=28893.114s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28893114,2.189,-4.998,0.000,169.76,169.79,3.490,-12.220*50 [GPS=28893.126s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28893126,2.189,-4.998,0.000,169.76,169.79,3.490,-12.220*51 [GPS=28893.144s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893144,2.189,-4.998,0.000,169.76,169.79,3.490,-12.220*70 [GPS=28893.156s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893156,2.189,-4.998,0.000,169.76,169.79,3.490,-12.220*73 [GPS=28893.156s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1231,follow_path,28893156,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*56 [GPS=28893.180s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28893180,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*5F [GPS=28893.186s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893186,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*58 [GPS=28893.198s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893198,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*57 [GPS=28893.222s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893222,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*55 [GPS=28893.234s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.000,76.92,1510,1231,follow_path,28893234,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*53 [GPS=28893.246s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893246,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*57 [GPS=28893.252s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893252,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*52 [GPS=28893.263s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893263,2.197,-5.043,0.000,169.75,169.79,3.490,-12.220*50 [GPS=28893.287s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28893287,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*51 [GPS=28893.299s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893299,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*5C [GPS=28893.310s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893310,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*5D [GPS=28893.316s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893316,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*5B [GPS=28893.328s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893328,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*57 [GPS=28893.328s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.02,28893328*27 [GPS=28893.352s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893352,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*76 [GPS=28893.352s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893352,2.204,-5.085,-0.000,169.76,169.79,3.490,-12.220*76 [GPS=28893.376s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.003,76.92,1502,1231,follow_path,28893376,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*70 [GPS=28893.388s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893388,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*70 [GPS=28893.394s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893394,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*7D [GPS=28893.417s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893417,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*71 [GPS=28893.429s r=1] STM32 UART5 CTRL: $CTRL,0.449,0.000,76.92,1510,1231,follow_path,28893429,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*50 [GPS=28893.441s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893441,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*72 [GPS=28893.453s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893453,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*71 [GPS=28893.459s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893459,2.213,-5.133,-0.000,169.75,169.79,3.490,-12.220*7B [GPS=28893.471s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.004,76.92,1498,1231,follow_path,28893471,2.221,-5.175,-0.000,169.76,169.79,3.490,-12.220*50 [GPS=28893.495s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28893495,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*5F [GPS=28893.507s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893507,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*54 [GPS=28893.513s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893513,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*51 [GPS=28893.524s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893524,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*79 [GPS=28893.536s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893536,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*56 [GPS=28893.548s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893548,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*5F [GPS=28893.560s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28893560,2.221,-5.175,-0.000,169.77,169.79,3.490,-12.220*78 [GPS=28893.578s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28893578,2.229,-5.222,-0.000,169.76,169.79,3.490,-12.220*7B [GPS=28893.590s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28893590,2.229,-5.222,-0.000,169.76,169.79,3.490,-12.220*7F [GPS=28893.602s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28893602,2.229,-5.222,-0.000,169.76,169.79,3.490,-12.220*75 [GPS=28893.614s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28893614,2.229,-5.222,-0.000,169.76,169.79,3.490,-12.220*71 [GPS=28893.637s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893637,2.229,-5.222,-0.000,169.76,169.79,3.490,-12.220*70 [GPS=28893.649s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893649,2.229,-5.222,-0.000,169.75,169.79,3.490,-12.220*72 [GPS=28893.655s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1231,follow_path,28893655,2.229,-5.222,-0.000,169.75,169.79,3.490,-12.220*7C [GPS=28893.667s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893667,2.229,-5.222,-0.000,169.75,169.79,3.490,-12.220*7E [GPS=28893.678s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.006,76.92,1497,1231,follow_path,28893678,2.237,-5.267,-0.000,169.77,169.79,3.490,-12.220*50 [GPS=28893.702s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28893702,2.237,-5.267,-0.000,169.77,169.79,3.490,-12.220*55 [GPS=28893.708s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28893708,2.237,-5.267,-0.000,169.78,169.79,3.490,-12.220*53 [GPS=28893.720s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893720,2.237,-5.267,-0.000,169.78,169.79,3.490,-12.220*5A [GPS=28893.732s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893732,2.237,-5.267,-0.000,169.78,169.79,3.490,-12.220*59 [GPS=28893.744s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28893744,2.237,-5.267,-0.000,169.78,169.79,3.490,-12.220*5B [GPS=28893.756s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893756,2.237,-5.267,-0.000,169.78,169.79,3.490,-12.220*5B [GPS=28893.769s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.008,76.92,1504,1231,follow_path,28893769,2.245,-5.309,0.000,169.76,169.79,3.490,-12.220*59 [GPS=28893.786s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893786,2.245,-5.309,0.000,169.76,169.79,3.490,-12.220*78 [GPS=28893.798s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28893798,2.245,-5.309,0.000,169.76,169.79,3.490,-12.220*58 [GPS=28893.810s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28893810,2.245,-5.309,0.000,169.76,169.79,3.490,-12.220*54 [GPS=28893.822s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.002,76.92,1501,1231,follow_path,28893822,2.245,-5.309,0.000,169.75,169.79,3.490,-12.220*5D [GPS=28893.840s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893840,2.245,-5.309,0.000,169.75,169.79,3.490,-12.220*5A [GPS=28893.852s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1510,1231,follow_path,28893852,2.245,-5.309,0.000,169.75,169.79,3.490,-12.220*59 [GPS=28893.864s r=1] STM32 UART5 CTRL: $CTRL,0.449,-0.001,76.92,1501,1231,follow_path,28893864,2.245,-5.309,0.000,169.75,169.79,3.490,-12.220*5C [GPS=28893.875s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.004,76.92,1498,1231,follow_path,28893875,2.253,-5.354,0.000,169.76,169.79,3.490,-12.220*71 [GPS=28893.893s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28893893,2.253,-5.354,0.000,169.76,169.79,3.490,-12.220*51 [GPS=28893.904s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28893904,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*73 [GPS=28893.921s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893921,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*59 [GPS=28893.927s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893927,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*73 [GPS=28893.939s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28893939,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*7C [GPS=28893.939s r=1] STM32 UART5 POSE: $POSE,2.253,-5.354,0.000,169.77,0.00,0.15,3.490,-12.220,28893939*28 [GPS=28893.963s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28893963,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*5E [GPS=28893.963s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28893963,2.253,-5.354,0.000,169.77,169.79,3.490,-12.220*5E [GPS=28893.981s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28893981,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*50 [GPS=28893.993s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28893993,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*50 [GPS=28894.005s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894005,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*51 [GPS=28894.016s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28894016,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*53 [GPS=28894.040s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894040,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*51 [GPS=28894.046s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894046,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*7A [GPS=28894.058s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894058,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*59 [GPS=28894.070s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894070,2.261,-5.398,0.000,169.76,169.79,3.490,-12.220*52 [GPS=28894.082s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28894082,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*79 [GPS=28894.094s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894094,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*7C [GPS=28894.118s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894118,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*55 [GPS=28894.124s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894124,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28894.136s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894136,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*58 [GPS=28894.147s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894147,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*5F [GPS=28894.159s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894159,2.269,-5.442,0.000,169.77,169.79,3.490,-12.220*7C [GPS=28894.171s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28894171,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*71 [GPS=28894.189s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894189,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28894.201s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894201,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*74 [GPS=28894.213s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894213,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28894.225s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894225,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*72 [GPS=28894.249s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894249,2.277,-5.487,0.000,169.77,169.79,3.490,-12.220*78 [GPS=28894.255s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28894255,2.277,-5.487,0.000,169.78,169.79,3.490,-12.220*7B [GPS=28894.266s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894266,2.277,-5.487,0.000,169.78,169.79,3.490,-12.220*7A [GPS=28894.278s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28894278,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*52 [GPS=28894.290s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894290,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*57 [GPS=28894.308s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894308,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*57 [GPS=28894.320s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894320,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*5C [GPS=28894.332s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894332,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*5F [GPS=28894.332s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.02,28894332*2B [GPS=28894.344s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894344,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*73 [GPS=28894.356s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894356,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*70 [GPS=28894.368s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28894368,2.286,-5.534,0.000,169.77,169.79,3.490,-12.220*51 [GPS=28894.374s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28894374,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*72 [GPS=28894.398s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894398,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*5D [GPS=28894.410s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894410,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28894.421s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894421,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*74 [GPS=28894.433s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894433,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28894.451s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894451,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*5E [GPS=28894.463s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894463,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*5F [GPS=28894.475s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894475,2.293,-5.577,0.000,169.77,169.79,3.490,-12.220*75 [GPS=28894.487s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894487,2.301,-5.622,-0.000,169.77,169.79,3.490,-12.220*5C [GPS=28894.499s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894499,2.301,-5.622,-0.000,169.77,169.79,3.490,-12.220*7E [GPS=28894.505s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894505,2.301,-5.622,-0.000,169.77,169.79,3.490,-12.220*7B [GPS=28894.529s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894529,2.301,-5.622,-0.000,169.77,169.79,3.490,-12.220*59 [GPS=28894.541s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894541,2.301,-5.622,-0.000,169.78,169.79,3.490,-12.220*58 [GPS=28894.553s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894553,2.301,-5.622,-0.000,169.78,169.79,3.490,-12.220*5B [GPS=28894.565s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894565,2.301,-5.622,-0.000,169.78,169.79,3.490,-12.220*5E [GPS=28894.571s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28894571,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*71 [GPS=28894.583s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894583,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*7C [GPS=28894.607s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894607,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*72 [GPS=28894.619s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894619,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*7D [GPS=28894.631s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894631,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*76 [GPS=28894.637s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894637,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*71 [GPS=28894.649s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894649,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*78 [GPS=28894.673s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894673,2.309,-5.667,-0.000,169.77,169.79,3.490,-12.220*70 [GPS=28894.673s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28894673,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*52 [GPS=28894.697s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894697,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*77 [GPS=28894.703s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894703,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*56 [GPS=28894.715s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894715,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*51 [GPS=28894.738s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894738,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28894.750s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894750,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28894.761s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894761,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28894.773s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894773,2.318,-5.712,-0.000,169.78,169.79,3.490,-12.220*51 [GPS=28894.773s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28894773,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*5C [GPS=28894.803s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894803,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*55 [GPS=28894.815s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28894815,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*53 [GPS=28894.827s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894827,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*7E [GPS=28894.839s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894839,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*5C [GPS=28894.845s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894845,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*7A [GPS=28894.857s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894857,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*54 [GPS=28894.869s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894869,2.326,-5.757,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28894.869s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28894869,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*58 [GPS=28894.899s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894899,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*55 [GPS=28894.911s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894911,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*54 [GPS=28894.923s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894923,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*78 [GPS=28894.935s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894935,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*52 [GPS=28894.935s r=1] STM32 UART5 POSE: $POSE,2.334,-5.802,0.000,169.77,0.00,-0.00,3.490,-12.220,28894935*02 [GPS=28894.959s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28894959,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*75 [GPS=28894.971s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28894971,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*52 [GPS=28894.977s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28894977,2.334,-5.802,0.000,169.77,169.79,3.490,-12.220*55 [GPS=28894.989s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28894989,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*76 [GPS=28895.001s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895001,2.342,-5.847,0.000,169.77,169.79,3.490,-12.220*5C [GPS=28895.025s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895025,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*78 [GPS=28895.037s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895037,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28895.043s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895043,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*79 [GPS=28895.055s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895055,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*7E [GPS=28895.067s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895067,2.342,-5.847,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28895.079s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895079,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*7A [GPS=28895.097s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895097,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*7B [GPS=28895.109s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895109,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*7D [GPS=28895.121s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895121,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*77 [GPS=28895.133s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895133,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*74 [GPS=28895.145s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895145,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28895.157s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895157,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*76 [GPS=28895.175s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895175,2.350,-5.892,0.000,169.78,169.79,3.490,-12.220*5B [GPS=28895.175s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28895175,2.358,-5.934,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28895.199s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895199,2.358,-5.934,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28895.211s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895211,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*51 [GPS=28895.223s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895223,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*51 [GPS=28895.241s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895241,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*55 [GPS=28895.253s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895253,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*56 [GPS=28895.265s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895265,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*7E [GPS=28895.277s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895277,2.358,-5.934,0.000,169.77,169.79,3.490,-12.220*51 [GPS=28895.289s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28895289,2.366,-5.979,0.000,169.78,169.79,3.490,-12.220*75 [GPS=28895.295s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895295,2.366,-5.979,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28895.319s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28895319,2.366,-5.979,0.000,169.78,169.79,3.490,-12.220*7E [GPS=28895.331s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895331,2.366,-5.979,0.000,169.78,169.79,3.490,-12.220*74 [GPS=28895.331s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.00,28895331*2B [GPS=28895.343s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895343,2.366,-5.979,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28895.355s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895355,2.366,-5.979,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28895.361s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895361,2.366,-5.979,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28895.373s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895373,2.366,-5.979,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28895.397s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28895397,2.374,-6.025,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28895.409s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895409,2.374,-6.025,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28895.415s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28895415,2.374,-6.025,0.000,169.77,169.79,3.490,-12.220*54 [GPS=28895.427s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895427,2.374,-6.025,0.000,169.77,169.79,3.490,-12.220*57 [GPS=28895.439s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895439,2.374,-6.025,0.000,169.77,169.79,3.490,-12.220*59 [GPS=28895.463s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895463,2.374,-6.025,0.000,169.76,169.79,3.490,-12.220*57 [GPS=28895.475s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895475,2.374,-6.025,0.000,169.76,169.79,3.490,-12.220*51 [GPS=28895.481s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895481,2.374,-6.025,0.000,169.76,169.79,3.490,-12.220*5B [GPS=28895.493s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.007,76.92,1497,1231,follow_path,28895493,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*57 [GPS=28895.505s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895505,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*7C [GPS=28895.529s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895529,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*73 [GPS=28895.541s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895541,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*50 [GPS=28895.553s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895553,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*53 [GPS=28895.559s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895559,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*75 [GPS=28895.571s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895571,2.382,-6.070,-0.000,169.78,169.79,3.490,-12.220*53 [GPS=28895.583s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895583,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*5F [GPS=28895.607s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895607,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28895.613s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895613,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*55 [GPS=28895.625s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895625,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*51 [GPS=28895.636s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895636,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*7E [GPS=28895.648s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895648,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*5B [GPS=28895.672s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895672,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*7E [GPS=28895.678s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895678,2.390,-6.115,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28895.690s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895690,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*50 [GPS=28895.702s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895702,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*5A [GPS=28895.714s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28895714,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*71 [GPS=28895.737s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895737,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*5C [GPS=28895.743s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895743,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28895.755s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895755,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*58 [GPS=28895.767s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895767,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28895.779s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895779,2.398,-6.157,-0.000,169.78,169.79,3.490,-12.220*56 [GPS=28895.791s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895791,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*79 [GPS=28895.815s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28895815,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*57 [GPS=28895.821s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895821,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28895.833s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895833,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28895.845s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895845,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28895.857s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895857,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28895.881s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895881,2.406,-6.205,-0.000,169.78,169.79,3.490,-12.220*76 [GPS=28895.887s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895887,2.406,-6.205,-0.000,169.77,169.79,3.490,-12.220*7F [GPS=28895.899s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28895899,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*55 [GPS=28895.911s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895911,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*7A [GPS=28895.923s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28895923,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*57 [GPS=28895.945s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895945,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*7B [GPS=28895.945s r=1] STM32 UART5 POSE: $POSE,2.414,-6.247,-0.000,169.78,0.00,0.15,3.490,-12.220,28895945*02 [GPS=28895.950s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895950,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28895.962s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895962,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*7E [GPS=28895.974s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895974,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*79 [GPS=28895.986s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28895986,2.414,-6.247,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28895.998s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28895998,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28896.016s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896016,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*7C [GPS=28896.028s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896028,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28896.040s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896040,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*7E [GPS=28896.052s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896052,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28896.064s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896064,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*78 [GPS=28896.082s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896082,2.422,-6.294,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28896.082s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896082,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28896.106s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896106,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*5B [GPS=28896.118s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896118,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*79 [GPS=28896.130s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896130,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28896.142s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896142,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*76 [GPS=28896.160s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896160,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*5B [GPS=28896.172s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28896172,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*59 [GPS=28896.184s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896184,2.430,-6.336,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28896.196s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28896196,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*79 [GPS=28896.208s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896208,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28896.226s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896226,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*72 [GPS=28896.238s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896238,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28896.250s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896250,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28896.262s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896262,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28896.274s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896274,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*59 [GPS=28896.286s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896286,2.438,-6.381,0.000,169.78,169.79,3.490,-12.220*79 [GPS=28896.304s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896304,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28896.316s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896316,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28896.328s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896328,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28896.328s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.01,28896328*21 [GPS=28896.340s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28896340,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28896.352s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896352,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*72 [GPS=28896.358s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28896358,2.446,-6.426,0.000,169.77,169.79,3.490,-12.220*5B [GPS=28896.382s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896382,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28896.382s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896382,2.446,-6.426,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28896.406s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28896406,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*76 [GPS=28896.412s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896412,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28896.423s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896423,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*73 [GPS=28896.447s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896447,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28896.459s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896459,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28896.471s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896471,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*75 [GPS=28896.477s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896477,2.455,-6.471,0.000,169.78,169.79,3.490,-12.220*73 [GPS=28896.489s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896489,2.455,-6.471,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28896.501s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28896501,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28896.525s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896525,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28896.537s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896537,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28896.543s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896543,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28896.555s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28896555,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28896.567s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896567,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28896.590s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896590,2.463,-6.516,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28896.590s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28896590,2.471,-6.561,-0.000,169.78,169.79,3.490,-12.220*53 [GPS=28896.614s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28896614,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*5E [GPS=28896.620s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896620,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28896.632s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896632,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*5A [GPS=28896.655s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896655,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*77 [GPS=28896.666s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896666,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*5B [GPS=28896.677s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896677,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*77 [GPS=28896.689s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896689,2.471,-6.561,-0.000,169.79,169.79,3.490,-12.220*5B [GPS=28896.701s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28896701,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*78 [GPS=28896.707s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896707,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*79 [GPS=28896.731s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896731,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28896.743s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896743,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*54 [GPS=28896.755s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28896755,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28896.767s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896767,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28896.773s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896773,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*7A [GPS=28896.785s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28896785,2.479,-6.605,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28896.809s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28896809,2.487,-6.650,-0.000,169.78,169.79,3.490,-12.220*57 [GPS=28896.821s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896821,2.487,-6.650,-0.000,169.78,169.79,3.490,-12.220*73 [GPS=28896.833s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896833,2.487,-6.650,-0.000,169.79,169.79,3.490,-12.220*5D [GPS=28896.845s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896845,2.487,-6.650,-0.000,169.79,169.79,3.490,-12.220*5D [GPS=28896.851s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896851,2.487,-6.650,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28896.874s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896874,2.487,-6.650,-0.000,169.79,169.79,3.490,-12.220*5E [GPS=28896.886s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28896886,2.487,-6.650,-0.000,169.79,169.79,3.490,-12.220*53 [GPS=28896.898s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896898,2.487,-6.650,-0.000,169.80,169.79,3.490,-12.220*5A [GPS=28896.909s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28896909,2.495,-6.695,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28896.915s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896915,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28896.939s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896939,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28896.939s r=1] STM32 UART5 POSE: $POSE,2.495,-6.695,0.000,169.79,0.00,-0.15,3.490,-12.220,28896939*09 [GPS=28896.950s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28896950,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28896.962s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28896962,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28896.974s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896974,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*79 [GPS=28896.986s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28896986,2.495,-6.695,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28896.992s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28896992,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28897.016s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897016,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*7C [GPS=28897.027s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897027,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28897.039s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897039,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28897.045s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897045,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*7A [GPS=28897.069s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897069,2.503,-6.739,0.000,169.78,169.79,3.490,-12.220*74 [GPS=28897.081s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897081,2.503,-6.739,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28897.093s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897093,2.503,-6.739,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28897.098s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28897098,2.511,-6.784,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28897.110s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897110,2.511,-6.784,0.000,169.78,169.79,3.490,-12.220*7F [GPS=28897.123s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897123,2.511,-6.784,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28897.145s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897145,2.511,-6.784,0.000,169.78,169.79,3.490,-12.220*7E [GPS=28897.156s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897156,2.511,-6.784,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28897.168s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897168,2.511,-6.784,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28897.180s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897180,2.511,-6.784,0.000,169.79,169.79,3.490,-12.220*5A [GPS=28897.186s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897186,2.511,-6.784,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28897.198s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28897198,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28897.222s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897222,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28897.234s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897234,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28897.246s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897246,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28897.258s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897258,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28897.264s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897264,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*7F [GPS=28897.288s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897288,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*7C [GPS=28897.288s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897288,2.519,-6.828,0.000,169.78,169.79,3.490,-12.220*7C [GPS=28897.312s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897312,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28897.324s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897324,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*79 [GPS=28897.324s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.00,28897324*2D [GPS=28897.330s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897330,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28897.354s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897354,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28897.365s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897365,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28897.377s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897377,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28897.383s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897383,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*75 [GPS=28897.394s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897394,2.527,-6.873,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28897.417s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28897417,2.535,-6.917,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28897.429s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897429,2.535,-6.917,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28897.441s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28897441,2.535,-6.917,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28897.453s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897453,2.535,-6.917,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28897.459s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28897459,2.535,-6.917,0.000,169.77,169.79,3.490,-12.220*56 [GPS=28897.483s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28897483,2.535,-6.917,0.000,169.77,169.79,3.490,-12.220*52 [GPS=28897.495s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897495,2.535,-6.917,0.000,169.77,169.79,3.490,-12.220*56 [GPS=28897.495s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.006,76.92,1497,1231,follow_path,28897495,2.543,-6.962,-0.000,169.79,169.79,3.490,-12.220*52 [GPS=28897.519s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897519,2.543,-6.962,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28897.525s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28897525,2.543,-6.962,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28897.537s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897537,2.543,-6.962,-0.000,169.79,169.79,3.490,-12.220*7E [GPS=28897.561s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28897561,2.543,-6.962,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28897.573s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897573,2.543,-6.962,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28897.579s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897579,2.543,-6.962,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28897.591s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897591,2.543,-6.962,-0.000,169.78,169.79,3.490,-12.220*5E [GPS=28897.603s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897603,2.551,-7.007,-0.000,169.78,169.79,3.490,-12.220*5F [GPS=28897.626s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897626,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*58 [GPS=28897.637s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897637,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28897.649s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897649,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28897.655s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897655,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*5C [GPS=28897.667s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897667,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*70 [GPS=28897.691s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28897691,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28897.691s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28897691,2.551,-7.007,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28897.715s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28897715,2.559,-7.051,-0.000,169.79,169.79,3.490,-12.220*7F [GPS=28897.721s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897721,2.559,-7.051,-0.000,169.79,169.79,3.490,-12.220*54 [GPS=28897.733s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897733,2.559,-7.051,-0.000,169.79,169.79,3.490,-12.220*7A [GPS=28897.745s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897745,2.559,-7.051,-0.000,169.79,169.79,3.490,-12.220*57 [GPS=28897.769s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897769,2.559,-7.051,-0.000,169.79,169.79,3.490,-12.220*74 [GPS=28897.781s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28897781,2.559,-7.051,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28897.793s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897793,2.559,-7.051,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28897.799s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897799,2.559,-7.051,-0.000,169.78,169.79,3.490,-12.220*7A [GPS=28897.811s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28897811,2.567,-7.097,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28897.823s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897823,2.567,-7.097,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28897.847s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897847,2.567,-7.097,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28897.859s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897859,2.567,-7.097,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28897.865s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897865,2.567,-7.097,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28897.877s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897877,2.567,-7.097,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28897.889s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897889,2.567,-7.097,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28897.900s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28897900,2.567,-7.097,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28897.924s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897924,2.575,-7.141,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28897.930s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897930,2.575,-7.141,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28897.930s r=1] STM32 UART5 POSE: $POSE,2.575,-7.141,0.000,169.79,0.00,-0.00,3.490,-12.220,28897930*05 [GPS=28897.942s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28897942,2.575,-7.141,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28897.954s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897954,2.575,-7.141,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28897.978s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28897978,2.575,-7.141,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28897.990s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28897990,2.575,-7.141,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28897.996s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28897996,2.575,-7.141,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28898.008s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28898008,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*76 [GPS=28898.020s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898020,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*50 [GPS=28898.032s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898032,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28898.050s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898050,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28898.062s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898062,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28898.074s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898074,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28898.086s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898086,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28898.098s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898098,2.583,-7.186,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28898.110s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898110,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28898.128s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898128,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28898.140s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898140,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28898.152s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898152,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28898.164s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898164,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28898.176s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898176,2.591,-7.229,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28898.194s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1500,1231,follow_path,28898194,2.591,-7.229,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28898.194s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898194,2.591,-7.229,0.000,169.78,169.79,3.490,-12.220*5B [GPS=28898.218s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28898218,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*71 [GPS=28898.230s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898230,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*56 [GPS=28898.242s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898242,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*7F [GPS=28898.254s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898254,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28898.272s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898272,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28898.284s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898284,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*59 [GPS=28898.296s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898296,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*5B [GPS=28898.308s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898308,2.599,-7.274,0.000,169.78,169.79,3.490,-12.220*70 [GPS=28898.320s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1498,1231,follow_path,28898320,2.607,-7.319,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28898.320s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.00,28898320*26 [GPS=28898.326s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898326,2.607,-7.319,0.000,169.79,169.79,3.490,-12.220*5E [GPS=28898.350s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898350,2.607,-7.319,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28898.362s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898362,2.607,-7.319,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28898.373s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898373,2.607,-7.319,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28898.385s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898385,2.607,-7.319,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28898.391s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898391,2.607,-7.319,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28898.403s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898403,2.607,-7.319,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28898.427s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28898427,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*52 [GPS=28898.439s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898439,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*72 [GPS=28898.445s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898445,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*54 [GPS=28898.457s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898457,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*7B [GPS=28898.481s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898481,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*70 [GPS=28898.493s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898493,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*73 [GPS=28898.505s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898505,2.615,-7.364,-0.000,169.79,169.79,3.490,-12.220*7D [GPS=28898.517s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898517,2.623,-7.409,-0.000,169.79,169.79,3.490,-12.220*76 [GPS=28898.523s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898523,2.623,-7.409,-0.000,169.79,169.79,3.490,-12.220*5D [GPS=28898.535s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898535,2.623,-7.409,-0.000,169.79,169.79,3.490,-12.220*76 [GPS=28898.559s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898559,2.623,-7.409,-0.000,169.78,169.79,3.490,-12.220*7D [GPS=28898.571s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898571,2.623,-7.409,-0.000,169.78,169.79,3.490,-12.220*76 [GPS=28898.577s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898577,2.623,-7.409,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28898.589s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898589,2.623,-7.409,-0.000,169.78,169.79,3.490,-12.220*5C [GPS=28898.601s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898601,2.623,-7.409,-0.000,169.78,169.79,3.490,-12.220*73 [GPS=28898.612s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28898612,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*56 [GPS=28898.635s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28898635,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*7C [GPS=28898.647s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898647,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28898.659s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898659,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*5A [GPS=28898.665s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898665,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28898.677s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898677,2.632,-7.454,-0.000,169.79,169.79,3.490,-12.220*56 [GPS=28898.701s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898701,2.632,-7.454,-0.000,169.80,169.79,3.490,-12.220*50 [GPS=28898.701s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898701,2.632,-7.454,-0.000,169.80,169.79,3.490,-12.220*50 [GPS=28898.725s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28898725,2.640,-7.499,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28898.731s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898731,2.640,-7.499,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28898.742s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898742,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28898.766s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898766,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28898.778s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898778,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28898.784s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898784,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28898.796s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898796,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28898.808s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898808,2.640,-7.499,0.000,169.78,169.79,3.490,-12.220*79 [GPS=28898.820s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1498,1231,follow_path,28898820,2.648,-7.543,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28898.844s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28898844,2.648,-7.543,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28898.856s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898856,2.648,-7.543,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28898.861s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898861,2.648,-7.543,0.000,169.80,169.79,3.490,-12.220*7E [GPS=28898.873s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898873,2.648,-7.543,0.000,169.80,169.79,3.490,-12.220*7C [GPS=28898.885s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898885,2.648,-7.543,0.000,169.80,169.79,3.490,-12.220*74 [GPS=28898.909s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898909,2.648,-7.543,0.000,169.80,169.79,3.490,-12.220*70 [GPS=28898.909s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28898909,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28898.927s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898927,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28898.927s r=1] STM32 UART5 POSE: $POSE,2.656,-7.588,0.000,169.79,0.00,-0.15,3.490,-12.220,28898927*0B [GPS=28898.939s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898939,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28898.950s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28898950,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28898.974s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28898974,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28898.986s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28898986,2.656,-7.588,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28898.992s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28898992,2.656,-7.588,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28899.004s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899004,2.656,-7.588,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28899.016s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1498,1231,follow_path,28899016,2.664,-7.633,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28899.028s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899028,2.664,-7.633,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28899.052s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899052,2.664,-7.633,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28899.064s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899064,2.664,-7.633,0.000,169.80,169.79,3.490,-12.220*79 [GPS=28899.070s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899070,2.664,-7.633,0.000,169.80,169.79,3.490,-12.220*7C [GPS=28899.082s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899082,2.664,-7.633,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28899.094s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899094,2.664,-7.633,0.000,169.80,169.79,3.490,-12.220*76 [GPS=28899.105s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899105,2.664,-7.633,0.000,169.80,169.79,3.490,-12.220*7E [GPS=28899.122s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28899122,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28899.134s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899134,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28899.146s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899146,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*79 [GPS=28899.158s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899158,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*5B [GPS=28899.182s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899182,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28899.188s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899188,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28899.199s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899199,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28899.211s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899211,2.672,-7.677,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28899.223s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899223,2.680,-7.722,-0.000,169.79,169.79,3.490,-12.220*75 [GPS=28899.247s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899247,2.680,-7.722,-0.000,169.79,169.79,3.490,-12.220*5B [GPS=28899.259s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899259,2.680,-7.722,-0.000,169.80,169.79,3.490,-12.220*52 [GPS=28899.265s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28899265,2.680,-7.722,-0.000,169.80,169.79,3.490,-12.220*5D [GPS=28899.277s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899277,2.680,-7.722,-0.000,169.80,169.79,3.490,-12.220*5F [GPS=28899.289s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899289,2.680,-7.722,-0.000,169.80,169.79,3.490,-12.220*5E [GPS=28899.301s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899301,2.680,-7.722,-0.000,169.80,169.79,3.490,-12.220*72 [GPS=28899.313s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28899313,2.687,-7.764,-0.000,169.79,169.79,3.490,-12.220*72 [GPS=28899.313s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,-0.00,28899313*27 [GPS=28899.331s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899331,2.687,-7.764,-0.000,169.79,169.79,3.490,-12.220*73 [GPS=28899.343s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899343,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*77 [GPS=28899.354s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899354,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28899.366s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899366,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28899.390s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899390,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*79 [GPS=28899.396s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899396,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28899.408s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899408,2.687,-7.764,-0.000,169.78,169.79,3.490,-12.220*7E [GPS=28899.420s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28899420,2.696,-7.809,-0.000,169.79,169.79,3.490,-12.220*58 [GPS=28899.432s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899432,2.696,-7.809,-0.000,169.79,169.79,3.490,-12.220*5E [GPS=28899.449s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28899449,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*57 [GPS=28899.461s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899461,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*5F [GPS=28899.473s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899473,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*5D [GPS=28899.485s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899485,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*54 [GPS=28899.497s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899497,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*56 [GPS=28899.509s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899509,2.696,-7.809,-0.000,169.80,169.79,3.490,-12.220*7D [GPS=28899.515s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.005,76.92,1503,1231,follow_path,28899515,2.704,-7.854,0.000,169.79,169.79,3.490,-12.220*5E [GPS=28899.539s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899539,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*56 [GPS=28899.551s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28899551,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28899.563s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899563,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*75 [GPS=28899.575s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899575,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28899.592s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28899592,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*56 [GPS=28899.604s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28899604,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28899.616s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899616,2.704,-7.854,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28899.627s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28899627,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28899.639s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899639,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28899.657s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899657,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*76 [GPS=28899.669s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899669,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28899.681s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899681,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28899.693s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899693,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28899.705s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899705,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28899.717s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899717,2.712,-7.901,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28899.735s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28899735,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28899.747s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899747,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*75 [GPS=28899.759s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899759,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28899.771s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28899771,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28899.782s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899782,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28899.800s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28899800,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28899.812s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899812,2.720,-7.946,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28899.812s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899812,2.728,-7.988,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28899.836s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28899836,2.728,-7.988,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28899.848s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899848,2.728,-7.988,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28899.854s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899854,2.728,-7.988,0.000,169.80,169.79,3.490,-12.220*75 [GPS=28899.877s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28899877,2.728,-7.988,0.000,169.80,169.79,3.490,-12.220*77 [GPS=28899.889s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28899889,2.728,-7.988,0.000,169.80,169.79,3.490,-12.220*75 [GPS=28899.900s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28899900,2.728,-7.988,0.000,169.81,169.79,3.490,-12.220*77 [GPS=28899.913s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28899913,2.728,-7.988,0.000,169.81,169.79,3.490,-12.220*76 [GPS=28899.918s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.008,76.92,1504,1231,follow_path,28899918,2.736,-8.033,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28899.918s r=1] STM32 UART5 POSE: $POSE,2.736,-8.033,0.000,169.78,0.00,-0.30,3.490,-12.220,28899918*0D [GPS=28899.942s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28899942,2.736,-8.033,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28899.954s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28899954,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28899.966s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28899966,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*5A [GPS=28899.978s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899978,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*57 [GPS=28899.990s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28899990,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*51 [GPS=28900.009s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900009,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*58 [GPS=28900.009s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900009,2.736,-8.033,0.000,169.77,169.79,3.490,-12.220*58 [GPS=28900.032s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.010,76.92,1495,1231,follow_path,28900032,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*73 [GPS=28900.044s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900044,2.744,-8.078,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28900.056s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28900056,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*7F [GPS=28900.073s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28900073,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*7A [GPS=28900.085s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900085,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*5E [GPS=28900.098s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900098,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*53 [GPS=28900.104s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900104,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*7A [GPS=28900.116s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900116,2.744,-8.078,0.000,169.80,169.79,3.490,-12.220*54 [GPS=28900.128s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28900128,2.752,-8.122,-0.000,169.79,169.79,3.490,-12.220*7B [GPS=28900.152s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28900152,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*75 [GPS=28900.164s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900164,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*73 [GPS=28900.170s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900170,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*76 [GPS=28900.181s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900181,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*79 [GPS=28900.193s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900193,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*7B [GPS=28900.217s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900217,2.752,-8.122,-0.000,169.78,169.79,3.490,-12.220*74 [GPS=28900.217s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900217,2.752,-8.122,-0.000,169.77,169.79,3.490,-12.220*7B [GPS=28900.235s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.006,76.92,1497,1231,follow_path,28900235,2.760,-8.167,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28900.247s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900247,2.760,-8.167,-0.000,169.79,169.79,3.490,-12.220*5C [GPS=28900.259s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28900259,2.760,-8.167,-0.000,169.80,169.79,3.490,-12.220*54 [GPS=28900.271s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900271,2.760,-8.167,-0.000,169.80,169.79,3.490,-12.220*5E [GPS=28900.295s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900295,2.760,-8.167,-0.000,169.80,169.79,3.490,-12.220*55 [GPS=28900.301s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900301,2.760,-8.167,-0.000,169.80,169.79,3.490,-12.220*59 [GPS=28900.313s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900313,2.760,-8.167,-0.000,169.80,169.79,3.490,-12.220*5B [GPS=28900.313s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,0.01,28900313*27 [GPS=28900.325s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28900325,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*50 [GPS=28900.337s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28900337,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28900.349s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900349,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*5B [GPS=28900.373s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900373,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28900.379s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900379,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28900.391s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900391,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28900.403s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900403,2.768,-8.212,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28900.414s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900414,2.768,-8.212,0.000,169.78,169.79,3.490,-12.220*55 [GPS=28900.438s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28900438,2.776,-8.255,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28900.444s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900444,2.776,-8.255,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28900.456s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900456,2.776,-8.255,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28900.468s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900468,2.776,-8.255,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28900.479s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28900479,2.776,-8.255,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28900.497s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900497,2.776,-8.255,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28900.509s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900509,2.776,-8.255,0.000,169.80,169.79,3.490,-12.220*7E [GPS=28900.521s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900521,2.776,-8.255,0.000,169.80,169.79,3.490,-12.220*58 [GPS=28900.533s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28900533,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*54 [GPS=28900.545s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900545,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28900.563s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900563,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28900.574s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900574,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*50 [GPS=28900.586s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900586,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28900.598s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900598,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28900.610s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900610,2.784,-8.302,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28900.622s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900622,2.792,-8.344,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28900.640s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900640,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28900.652s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900652,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28900.664s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900664,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28900.676s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900676,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*55 [GPS=28900.688s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900688,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28900.706s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900706,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28900.718s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900718,2.792,-8.344,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28900.718s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.004,76.92,1498,1231,follow_path,28900718,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28900.742s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900742,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28900.754s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900754,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28900.766s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900766,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28900.784s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900784,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28900.796s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900796,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28900.808s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900808,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28900.820s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900820,2.800,-8.389,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28900.832s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28900832,2.808,-8.435,-0.000,169.79,169.79,3.490,-12.220*78 [GPS=28900.850s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900850,2.808,-8.435,-0.000,169.79,169.79,3.490,-12.220*7E [GPS=28900.862s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900862,2.808,-8.435,-0.000,169.79,169.79,3.490,-12.220*7E [GPS=28900.874s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900874,2.808,-8.435,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28900.886s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900886,2.808,-8.435,-0.000,169.79,169.79,3.490,-12.220*75 [GPS=28900.892s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28900892,2.808,-8.435,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28900.904s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900904,2.808,-8.435,-0.000,169.78,169.79,3.490,-12.220*7F [GPS=28900.916s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28900916,2.808,-8.435,-0.000,169.78,169.79,3.490,-12.220*7C [GPS=28900.916s r=1] STM32 UART5 POSE: $POSE,2.808,-8.435,-0.000,169.78,0.00,-0.00,3.490,-12.220,28900916*2C [GPS=28900.941s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1498,1231,follow_path,28900941,2.816,-8.480,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28900.953s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28900953,2.816,-8.480,-0.000,169.79,169.79,3.490,-12.220*7C [GPS=28900.959s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900959,2.816,-8.480,-0.000,169.79,169.79,3.490,-12.220*5B [GPS=28900.971s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28900971,2.816,-8.480,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28900.983s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28900983,2.816,-8.480,-0.000,169.80,169.79,3.490,-12.220*5B [GPS=28901.007s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901007,2.816,-8.480,-0.000,169.80,169.79,3.490,-12.220*5E [GPS=28901.018s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901018,2.816,-8.480,-0.000,169.80,169.79,3.490,-12.220*51 [GPS=28901.030s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901030,2.816,-8.480,-0.000,169.80,169.79,3.490,-12.220*5A [GPS=28901.036s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28901036,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28901.048s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901048,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*5C [GPS=28901.072s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901072,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*54 [GPS=28901.084s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901084,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*5C [GPS=28901.090s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901090,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*75 [GPS=28901.102s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901102,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*52 [GPS=28901.114s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901114,2.824,-8.525,-0.000,169.79,169.79,3.490,-12.220*78 [GPS=28901.126s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901126,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28901.150s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901150,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28901.156s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901156,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28901.168s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28901168,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28901.180s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901180,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*5E [GPS=28901.192s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901192,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28901.215s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901215,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28901.221s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901221,2.833,-8.570,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28901.221s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28901221,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28901.245s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901245,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*50 [GPS=28901.257s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901257,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28901.275s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901275,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28901.287s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901287,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28901.299s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901299,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28901.311s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901311,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*50 [GPS=28901.311s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,-0.00,28901311*08 [GPS=28901.323s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901323,2.841,-8.615,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28901.335s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901335,2.848,-8.657,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28901.353s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901353,2.848,-8.657,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28901.365s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901365,2.848,-8.657,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28901.377s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901377,2.848,-8.657,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28901.389s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901389,2.848,-8.657,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28901.401s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901401,2.848,-8.657,0.000,169.79,169.79,3.490,-12.220*75 [GPS=28901.407s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901407,2.848,-8.657,0.000,169.78,169.79,3.490,-12.220*5E [GPS=28901.419s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901419,2.848,-8.657,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28901.443s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28901443,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28901.455s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901455,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28901.467s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901467,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28901.473s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901473,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*7E [GPS=28901.497s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901497,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28901.509s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901509,2.856,-8.702,0.000,169.80,169.79,3.490,-12.220*75 [GPS=28901.521s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901521,2.856,-8.702,0.000,169.79,169.79,3.490,-12.220*55 [GPS=28901.533s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901533,2.856,-8.702,0.000,169.80,169.79,3.490,-12.220*7C [GPS=28901.539s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28901539,2.865,-8.748,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28901.551s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901551,2.865,-8.748,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28901.575s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901575,2.865,-8.748,0.000,169.79,169.79,3.490,-12.220*5A [GPS=28901.587s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901587,2.865,-8.748,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28901.599s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901599,2.865,-8.748,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28901.611s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901611,2.865,-8.748,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28901.617s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901617,2.865,-8.748,0.000,169.78,169.79,3.490,-12.220*5C [GPS=28901.629s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901629,2.865,-8.748,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28901.653s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28901653,2.873,-8.793,-0.000,169.79,169.79,3.490,-12.220*5F [GPS=28901.665s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901665,2.873,-8.793,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28901.675s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901675,2.873,-8.793,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28901.686s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901686,2.873,-8.793,-0.000,169.80,169.79,3.490,-12.220*53 [GPS=28901.692s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901692,2.873,-8.793,-0.000,169.80,169.79,3.490,-12.220*56 [GPS=28901.716s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901716,2.873,-8.793,-0.000,169.80,169.79,3.490,-12.220*5A [GPS=28901.728s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1500,1231,follow_path,28901728,2.873,-8.793,-0.000,169.80,169.79,3.490,-12.220*57 [GPS=28901.740s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.005,76.92,1503,1231,follow_path,28901740,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*78 [GPS=28901.752s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901752,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*7C [GPS=28901.764s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28901764,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*78 [GPS=28901.782s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901782,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*71 [GPS=28901.794s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901794,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*77 [GPS=28901.806s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901806,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*72 [GPS=28901.818s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901818,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*7C [GPS=28901.830s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901830,2.881,-8.837,-0.000,169.78,169.79,3.490,-12.220*76 [GPS=28901.836s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28901836,2.889,-8.882,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28901.860s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28901860,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28901.872s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28901872,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*72 [GPS=28901.884s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901884,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*79 [GPS=28901.896s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901896,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*7A [GPS=28901.902s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901902,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*5B [GPS=28901.914s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901914,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28901.914s r=1] STM32 UART5 POSE: $POSE,2.889,-8.882,0.000,169.80,0.00,0.15,3.490,-12.220,28901914*25 [GPS=28901.926s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28901926,2.889,-8.882,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28901.950s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.005,76.92,1503,1231,follow_path,28901950,2.897,-8.927,0.000,169.78,169.79,3.490,-12.220*5D [GPS=28901.962s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28901962,2.897,-8.927,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28901.968s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28901968,2.897,-8.927,0.000,169.78,169.79,3.490,-12.220*50 [GPS=28901.980s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28901980,2.897,-8.927,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28902.004s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902004,2.897,-8.927,0.000,169.78,169.79,3.490,-12.220*7C [GPS=28902.016s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902016,2.897,-8.927,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28902.021s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902021,2.897,-8.927,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28902.033s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902033,2.897,-8.927,0.000,169.79,169.79,3.490,-12.220*54 [GPS=28902.045s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902045,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28902.069s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902069,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28902.081s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902081,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28902.087s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902087,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28902.099s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902099,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28902.111s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902111,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28902.123s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902123,2.905,-8.972,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28902.135s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1502,1231,follow_path,28902135,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28902.153s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902153,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*7A [GPS=28902.165s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902165,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28902.177s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902177,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*50 [GPS=28902.189s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902189,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*7D [GPS=28902.201s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902201,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28902.225s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902225,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*54 [GPS=28902.231s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902231,2.913,-9.014,0.000,169.78,169.79,3.490,-12.220*50 [GPS=28902.243s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28902243,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*73 [GPS=28902.255s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902255,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*5A [GPS=28902.267s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902267,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*76 [GPS=28902.285s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902285,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28902.297s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902297,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28902.309s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902309,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28902.309s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,-0.00,28902309*02 [GPS=28902.321s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902321,2.921,-9.059,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28902.333s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902333,2.921,-9.059,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28902.345s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28902345,2.929,-9.105,-0.000,169.79,169.79,3.490,-12.220*59 [GPS=28902.363s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902363,2.929,-9.105,-0.000,169.79,169.79,3.490,-12.220*5F [GPS=28902.375s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902375,2.929,-9.105,-0.000,169.79,169.79,3.490,-12.220*58 [GPS=28902.387s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902387,2.929,-9.105,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28902.399s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902399,2.929,-9.105,-0.000,169.79,169.79,3.490,-12.220*76 [GPS=28902.411s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902411,2.929,-9.105,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28902.423s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902423,2.929,-9.105,-0.000,169.78,169.79,3.490,-12.220*70 [GPS=28902.429s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902429,2.929,-9.105,-0.000,169.78,169.79,3.490,-12.220*57 [GPS=28902.453s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28902453,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*56 [GPS=28902.465s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902465,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28902.477s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902477,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*53 [GPS=28902.489s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902489,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*53 [GPS=28902.507s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902507,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*78 [GPS=28902.519s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902519,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*5A [GPS=28902.531s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902531,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28902.543s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28902543,2.937,-9.150,-0.000,169.79,169.79,3.490,-12.220*7B [GPS=28902.555s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902555,2.945,-9.195,0.000,169.79,169.79,3.490,-12.220*5E [GPS=28902.561s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902561,2.945,-9.195,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28902.584s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902584,2.945,-9.195,0.000,169.78,169.79,3.490,-12.220*53 [GPS=28902.597s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902597,2.945,-9.195,0.000,169.78,169.79,3.490,-12.220*51 [GPS=28902.603s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902603,2.945,-9.195,0.000,169.78,169.79,3.490,-12.220*5F [GPS=28902.615s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902615,2.945,-9.195,0.000,169.78,169.79,3.490,-12.220*59 [GPS=28902.627s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902627,2.945,-9.195,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28902.639s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.004,76.92,1498,1231,follow_path,28902639,2.953,-9.240,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28902.663s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902663,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*7F [GPS=28902.669s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902669,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*75 [GPS=28902.681s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28902681,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*73 [GPS=28902.693s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28902693,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*70 [GPS=28902.705s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902705,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*7E [GPS=28902.729s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902729,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28902.741s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902741,2.953,-9.240,0.000,169.80,169.79,3.490,-12.220*7F [GPS=28902.747s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.006,76.92,1503,1231,follow_path,28902747,2.961,-9.282,0.000,169.78,169.79,3.490,-12.220*58 [GPS=28902.759s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902759,2.961,-9.282,0.000,169.79,169.79,3.490,-12.220*7F [GPS=28902.771s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28902771,2.961,-9.282,0.000,169.78,169.79,3.490,-12.220*5A [GPS=28902.795s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28902795,2.961,-9.282,0.000,169.77,169.79,3.490,-12.220*5E [GPS=28902.801s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28902801,2.961,-9.282,0.000,169.77,169.79,3.490,-12.220*5C [GPS=28902.813s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902813,2.961,-9.282,0.000,169.77,169.79,3.490,-12.220*5D [GPS=28902.825s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902825,2.961,-9.282,0.000,169.77,169.79,3.490,-12.220*59 [GPS=28902.837s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902837,2.961,-9.282,0.000,169.77,169.79,3.490,-12.220*77 [GPS=28902.861s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.008,76.92,1496,1231,follow_path,28902861,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*73 [GPS=28902.867s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28902867,2.969,-9.328,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28902.879s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28902879,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*7F [GPS=28902.891s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902891,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*7A [GPS=28902.903s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902903,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28902.915s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902915,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*76 [GPS=28902.915s r=1] STM32 UART5 POSE: $POSE,2.969,-9.328,0.000,169.80,0.00,-0.00,3.490,-12.220,28902915*0B [GPS=28902.927s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28902927,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*76 [GPS=28902.939s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902939,2.969,-9.328,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28902.957s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28902957,2.977,-9.373,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28902.969s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28902969,2.977,-9.373,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28902.981s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28902981,2.977,-9.373,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28902.993s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28902993,2.977,-9.373,0.000,169.78,169.79,3.490,-12.220*52 [GPS=28903.011s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903011,2.977,-9.373,0.000,169.78,169.79,3.490,-12.220*50 [GPS=28903.022s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28903022,2.977,-9.373,0.000,169.78,169.79,3.490,-12.220*50 [GPS=28903.034s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903034,2.977,-9.373,0.000,169.78,169.79,3.490,-12.220*57 [GPS=28903.034s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28903034,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*54 [GPS=28903.058s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903058,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*76 [GPS=28903.076s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28903076,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*57 [GPS=28903.088s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903088,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.100s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903100,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*7B [GPS=28903.112s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903112,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.124s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903124,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*7D [GPS=28903.130s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903130,2.985,-9.418,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.142s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903142,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*5A [GPS=28903.166s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903166,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*70 [GPS=28903.178s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903178,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.190s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903190,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.202s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903202,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*71 [GPS=28903.208s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903208,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*56 [GPS=28903.232s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903232,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*72 [GPS=28903.244s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903244,2.993,-9.463,-0.000,169.79,169.79,3.490,-12.220*5E [GPS=28903.256s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28903256,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28903.262s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903262,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28903.274s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903274,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*7C [GPS=28903.298s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903298,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28903.310s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903310,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.310s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,-0.00,28903310*0B [GPS=28903.322s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903322,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.328s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903328,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28903.340s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903340,3.002,-9.508,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.364s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903364,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28903.376s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903376,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.388s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903388,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*78 [GPS=28903.400s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903400,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28903.406s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903406,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*54 [GPS=28903.417s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903417,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.441s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903441,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28903.441s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903441,3.009,-9.550,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28903.459s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28903459,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28903.471s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903471,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.483s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903483,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28903.495s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903495,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*75 [GPS=28903.519s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903519,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28903.531s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903531,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28903.537s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903537,3.017,-9.595,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28903.537s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28903537,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28903.561s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903561,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28903.585s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903585,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.591s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903591,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.602s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903602,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*5F [GPS=28903.614s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903614,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28903.626s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903626,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*59 [GPS=28903.638s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903638,3.025,-9.640,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.655s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28903655,3.033,-9.685,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28903.667s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903667,3.033,-9.685,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.679s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28903679,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*75 [GPS=28903.691s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903691,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*71 [GPS=28903.715s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903715,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*7C [GPS=28903.721s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903721,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*7B [GPS=28903.733s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903733,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28903.745s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903745,3.033,-9.685,0.000,169.80,169.79,3.490,-12.220*54 [GPS=28903.757s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903757,3.041,-9.730,-0.000,169.79,169.79,3.490,-12.220*77 [GPS=28903.769s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903769,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*51 [GPS=28903.787s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903787,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*51 [GPS=28903.798s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903798,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*73 [GPS=28903.810s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903810,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*51 [GPS=28903.822s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903822,3.041,-9.730,-0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.834s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903834,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*56 [GPS=28903.846s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903846,3.041,-9.730,-0.000,169.80,169.79,3.490,-12.220*7F [GPS=28903.864s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28903864,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*79 [GPS=28903.876s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903876,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*7B [GPS=28903.888s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903888,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*7A [GPS=28903.900s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28903900,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*57 [GPS=28903.912s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903912,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*78 [GPS=28903.912s r=1] STM32 UART5 POSE: $POSE,3.050,-9.775,-0.000,169.79,0.00,0.15,3.490,-12.220,28903912*01 [GPS=28903.930s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903930,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*78 [GPS=28903.941s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903941,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*53 [GPS=28903.952s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903952,3.050,-9.775,-0.000,169.79,169.79,3.490,-12.220*7C [GPS=28903.964s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28903964,3.058,-9.819,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28903.982s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28903982,3.058,-9.819,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28903.994s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28903994,3.058,-9.819,0.000,169.79,169.79,3.490,-12.220*7A [GPS=28904.006s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904006,3.058,-9.819,0.000,169.79,169.79,3.490,-12.220*53 [GPS=28904.018s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904018,3.058,-9.819,0.000,169.80,169.79,3.490,-12.220*76 [GPS=28904.030s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904030,3.058,-9.819,0.000,169.80,169.79,3.490,-12.220*7C [GPS=28904.042s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904042,3.058,-9.819,0.000,169.80,169.79,3.490,-12.220*78 [GPS=28904.048s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28904048,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28904.072s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904072,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*57 [GPS=28904.084s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904084,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*5E [GPS=28904.096s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904096,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28904.108s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904108,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28904.120s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904120,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*51 [GPS=28904.138s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904138,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28904.138s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904138,3.066,-9.864,0.000,169.79,169.79,3.490,-12.220*74 [GPS=28904.161s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904161,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28904.173s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904173,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*72 [GPS=28904.184s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904184,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*56 [GPS=28904.203s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904203,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28904.215s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904215,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28904.227s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904227,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28904.239s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904239,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*52 [GPS=28904.251s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904251,3.074,-9.909,0.000,169.79,169.79,3.490,-12.220*5D [GPS=28904.263s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904263,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*70 [GPS=28904.279s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904279,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*7B [GPS=28904.291s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904291,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*7D [GPS=28904.303s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904303,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*77 [GPS=28904.303s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,0.00,28904303*0E [GPS=28904.315s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904315,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*5C [GPS=28904.327s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904327,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*71 [GPS=28904.345s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904345,3.082,-9.954,0.000,169.79,169.79,3.490,-12.220*58 [GPS=28904.345s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904345,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*5B [GPS=28904.369s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904369,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*55 [GPS=28904.381s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904381,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*7E [GPS=28904.393s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904393,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*51 [GPS=28904.405s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904405,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*58 [GPS=28904.423s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28904423,3.090,-9.998,-0.000,169.80,169.79,3.490,-12.220*5B [GPS=28904.435s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904435,3.090,-9.998,-0.000,169.80,169.79,3.490,-12.220*70 [GPS=28904.447s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904447,3.090,-9.998,-0.000,169.79,169.79,3.490,-12.220*73 [GPS=28904.447s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28904447,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*4E [GPS=28904.471s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904471,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28904.489s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904489,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*4E [GPS=28904.501s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904501,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*62 [GPS=28904.513s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904513,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*4C [GPS=28904.525s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904525,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28904.537s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904537,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*4A [GPS=28904.543s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904543,3.098,-10.043,-0.000,169.79,169.79,3.490,-12.220*64 [GPS=28904.555s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904555,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*40 [GPS=28904.579s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904579,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*62 [GPS=28904.591s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904591,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*64 [GPS=28904.603s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904603,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*41 [GPS=28904.609s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904609,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*66 [GPS=28904.633s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904633,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28904.645s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904645,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*43 [GPS=28904.657s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904657,3.106,-10.086,0.000,169.79,169.79,3.490,-12.220*40 [GPS=28904.663s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28904663,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28904.675s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904675,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*4F [GPS=28904.687s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904687,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28904.710s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904710,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*61 [GPS=28904.722s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904722,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*60 [GPS=28904.728s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904728,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*6B [GPS=28904.740s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904740,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*64 [GPS=28904.751s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904751,3.114,-10.131,0.000,169.79,169.79,3.490,-12.220*64 [GPS=28904.775s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904775,3.122,-10.175,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28904.787s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904787,3.122,-10.175,0.000,169.79,169.79,3.490,-12.220*6A [GPS=28904.793s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904793,3.122,-10.175,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28904.805s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904805,3.122,-10.175,0.000,169.79,169.79,3.490,-12.220*43 [GPS=28904.817s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904817,3.122,-10.175,0.000,169.79,169.79,3.490,-12.220*6D [GPS=28904.841s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904841,3.122,-10.175,0.000,169.78,169.79,3.490,-12.220*6F [GPS=28904.853s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904853,3.122,-10.175,0.000,169.78,169.79,3.490,-12.220*6C [GPS=28904.853s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28904853,3.122,-10.175,0.000,169.78,169.79,3.490,-12.220*6C [GPS=28904.871s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28904871,3.130,-10.221,0.000,169.79,169.79,3.490,-12.220*43 [GPS=28904.883s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28904883,3.130,-10.221,0.000,169.79,169.79,3.490,-12.220*60 [GPS=28904.894s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28904894,3.130,-10.221,0.000,169.79,169.79,3.490,-12.220*4A [GPS=28904.918s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28904918,3.130,-10.221,0.000,169.80,169.79,3.490,-12.220*4A [GPS=28904.918s r=1] STM32 UART5 POSE: $POSE,3.130,-10.221,0.000,169.80,0.00,0.15,3.490,-12.220,28904918*1C [GPS=28904.924s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904924,3.130,-10.221,0.000,169.80,169.79,3.490,-12.220*47 [GPS=28904.936s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28904936,3.130,-10.221,0.000,169.80,169.79,3.490,-12.220*45 [GPS=28904.948s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28904948,3.130,-10.221,0.000,169.80,169.79,3.490,-12.220*4D [GPS=28904.960s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28904960,3.138,-10.265,0.000,169.79,169.79,3.490,-12.220*63 [GPS=28904.984s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28904984,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*6D [GPS=28904.990s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28904990,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*6B [GPS=28905.002s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28905002,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*68 [GPS=28905.014s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905014,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*6F [GPS=28905.026s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905026,3.138,-10.265,0.000,169.77,169.79,3.490,-12.220*61 [GPS=28905.049s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905049,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*66 [GPS=28905.049s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905049,3.138,-10.265,0.000,169.78,169.79,3.490,-12.220*66 [GPS=28905.067s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.007,76.92,1497,1231,follow_path,28905067,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*6E [GPS=28905.079s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905079,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*68 [GPS=28905.091s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28905091,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*6C [GPS=28905.103s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905103,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*64 [GPS=28905.121s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905121,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*65 [GPS=28905.133s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905133,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*67 [GPS=28905.145s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905145,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*4B [GPS=28905.157s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905157,3.146,-10.310,-0.000,169.80,169.79,3.490,-12.220*64 [GPS=28905.169s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.006,76.92,1503,1231,follow_path,28905169,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*44 [GPS=28905.181s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905181,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*46 [GPS=28905.199s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28905199,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*4D [GPS=28905.211s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905211,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*60 [GPS=28905.223s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28905223,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*4F [GPS=28905.235s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905235,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*4A [GPS=28905.247s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905247,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*4E [GPS=28905.253s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905253,3.154,-10.355,-0.000,169.78,169.79,3.490,-12.220*4A [GPS=28905.277s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28905277,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*4D [GPS=28905.289s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905289,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28905.301s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905301,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28905.301s r=1] STM32 UART5 STATE: $STATE,follow_path,-0.000,0.00,28905301*0D [GPS=28905.313s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905313,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28905.319s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905319,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*40 [GPS=28905.343s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905343,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*63 [GPS=28905.355s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905355,3.162,-10.398,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28905.355s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905355,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*66 [GPS=28905.379s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905379,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*69 [GPS=28905.391s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905391,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28905.409s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905409,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*69 [GPS=28905.421s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905421,3.170,-10.443,0.000,169.78,169.79,3.490,-12.220*62 [GPS=28905.433s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905433,3.170,-10.443,0.000,169.78,169.79,3.490,-12.220*61 [GPS=28905.445s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905445,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*4C [GPS=28905.451s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905451,3.170,-10.443,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28905.463s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28905463,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*46 [GPS=28905.487s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905487,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*4D [GPS=28905.499s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905499,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*42 [GPS=28905.511s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905511,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28905.517s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905517,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*44 [GPS=28905.529s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905529,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*65 [GPS=28905.541s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905541,3.178,-10.488,0.000,169.79,169.79,3.490,-12.220*47 [GPS=28905.553s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28905553,3.178,-10.488,0.000,169.80,169.79,3.490,-12.220*42 [GPS=28905.577s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28905577,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*69 [GPS=28905.583s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28905583,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28905.595s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905595,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*63 [GPS=28905.607s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905607,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*46 [GPS=28905.631s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905631,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28905.643s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905643,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*46 [GPS=28905.655s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905655,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*40 [GPS=28905.661s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905661,3.186,-10.533,0.000,169.79,169.79,3.490,-12.220*46 [GPS=28905.673s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28905673,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*4A [GPS=28905.685s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905685,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*6C [GPS=28905.709s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905709,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*44 [GPS=28905.721s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905721,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*4E [GPS=28905.727s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905727,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*65 [GPS=28905.739s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905739,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*6B [GPS=28905.751s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905751,3.194,-10.578,-0.000,169.79,169.79,3.490,-12.220*65 [GPS=28905.763s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28905763,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*4B [GPS=28905.787s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905787,3.202,-10.623,-0.000,169.79,169.79,3.490,-12.220*6E [GPS=28905.793s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28905793,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*46 [GPS=28905.804s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905804,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*46 [GPS=28905.816s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905816,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*44 [GPS=28905.828s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905828,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*48 [GPS=28905.846s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28905846,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*41 [GPS=28905.858s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905858,3.202,-10.623,-0.000,169.78,169.79,3.490,-12.220*4F [GPS=28905.870s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.004,76.92,1498,1231,follow_path,28905870,3.210,-10.666,0.000,169.79,169.79,3.490,-12.220*43 [GPS=28905.882s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28905882,3.210,-10.666,0.000,169.79,169.79,3.490,-12.220*66 [GPS=28905.894s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905894,3.210,-10.666,0.000,169.79,169.79,3.490,-12.220*4D [GPS=28905.906s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28905906,3.210,-10.666,0.000,169.79,169.79,3.490,-12.220*47 [GPS=28905.906s r=1] STM32 UART5 POSE: $POSE,3.210,-10.666,0.000,169.79,0.00,0.15,3.490,-12.220,28905906*12 [GPS=28905.924s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905924,3.210,-10.666,0.000,169.80,169.79,3.490,-12.220*41 [GPS=28905.936s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905936,3.210,-10.666,0.000,169.80,169.79,3.490,-12.220*42 [GPS=28905.948s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28905948,3.210,-10.666,0.000,169.80,169.79,3.490,-12.220*4B [GPS=28905.960s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28905960,3.210,-10.666,0.000,169.80,169.79,3.490,-12.220*40 [GPS=28905.960s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.006,76.92,1503,1231,follow_path,28905960,3.218,-10.711,0.000,169.78,169.79,3.490,-12.220*67 [GPS=28905.990s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28905990,3.218,-10.711,0.000,169.78,169.79,3.490,-12.220*6D [GPS=28906.002s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906002,3.218,-10.711,0.000,169.78,169.79,3.490,-12.220*6F [GPS=28906.014s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906014,3.218,-10.711,0.000,169.78,169.79,3.490,-12.220*6A [GPS=28906.026s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906026,3.218,-10.711,0.000,169.77,169.79,3.490,-12.220*66 [GPS=28906.038s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906038,3.218,-10.711,0.000,169.77,169.79,3.490,-12.220*6A [GPS=28906.050s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28906050,3.218,-10.711,0.000,169.77,169.79,3.490,-12.220*64 [GPS=28906.056s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906056,3.218,-10.711,0.000,169.77,169.79,3.490,-12.220*62 [GPS=28906.080s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.007,76.92,1497,1231,follow_path,28906080,3.226,-10.756,0.000,169.79,169.79,3.490,-12.220*4C [GPS=28906.091s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906091,3.226,-10.756,0.000,169.79,169.79,3.490,-12.220*68 [GPS=28906.102s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28906102,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*4A [GPS=28906.124s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906124,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*4D [GPS=28906.136s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906136,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*4F [GPS=28906.147s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906147,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*64 [GPS=28906.153s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906153,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*4D [GPS=28906.165s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906165,3.226,-10.756,0.000,169.80,169.79,3.490,-12.220*48 [GPS=28906.177s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.005,76.92,1503,1231,follow_path,28906177,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*6B [GPS=28906.200s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906200,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*6F [GPS=28906.206s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906206,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*6B [GPS=28906.218s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906218,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*66 [GPS=28906.229s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906229,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*65 [GPS=28906.252s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906252,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*69 [GPS=28906.264s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906264,3.235,-10.802,0.000,169.78,169.79,3.490,-12.220*6D [GPS=28906.264s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28906264,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*6C [GPS=28906.281s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906281,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28906.293s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906293,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*66 [GPS=28906.293s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,-0.00,28906293*04 [GPS=28906.316s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906316,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*46 [GPS=28906.328s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28906328,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*67 [GPS=28906.340s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906340,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*68 [GPS=28906.346s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906346,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*6E [GPS=28906.358s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906358,3.242,-10.845,-0.000,169.79,169.79,3.490,-12.220*4D [GPS=28906.369s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906369,3.250,-10.889,-0.000,169.79,169.79,3.490,-12.220*4F [GPS=28906.392s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906392,3.250,-10.889,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28906.398s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906398,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*43 [GPS=28906.410s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906410,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*44 [GPS=28906.421s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906421,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*6A [GPS=28906.444s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906444,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*45 [GPS=28906.455s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906455,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*44 [GPS=28906.466s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906466,3.250,-10.889,-0.000,169.78,169.79,3.490,-12.220*44 [GPS=28906.477s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.003,76.92,1499,1231,follow_path,28906477,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28906.494s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906494,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*47 [GPS=28906.505s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906505,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*4F [GPS=28906.517s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906517,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*4D [GPS=28906.528s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906528,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*41 [GPS=28906.540s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906540,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*62 [GPS=28906.558s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906558,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*6B [GPS=28906.558s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906558,3.259,-10.935,0.000,169.79,169.79,3.490,-12.220*6B [GPS=28906.586s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906586,3.266,-10.978,0.000,169.78,169.79,3.490,-12.220*6E [GPS=28906.592s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1500,1231,follow_path,28906592,3.266,-10.978,0.000,169.79,169.79,3.490,-12.220*45 [GPS=28906.603s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906603,3.266,-10.978,0.000,169.79,169.79,3.490,-12.220*62 [GPS=28906.626s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906626,3.266,-10.978,0.000,169.79,169.79,3.490,-12.220*64 [GPS=28906.637s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906637,3.266,-10.978,0.000,169.79,169.79,3.490,-12.220*64 [GPS=28906.648s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906648,3.266,-10.978,0.000,169.78,169.79,3.490,-12.220*6C [GPS=28906.660s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906660,3.266,-10.978,0.000,169.79,169.79,3.490,-12.220*4B [GPS=28906.666s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906666,3.274,-11.023,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28906.690s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906690,3.274,-11.023,0.000,169.79,169.79,3.490,-12.220*6C [GPS=28906.702s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906702,3.274,-11.023,0.000,169.79,169.79,3.490,-12.220*66 [GPS=28906.714s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906714,3.274,-11.023,0.000,169.79,169.79,3.490,-12.220*60 [GPS=28906.725s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906725,3.274,-11.023,0.000,169.78,169.79,3.490,-12.220*62 [GPS=28906.737s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906737,3.274,-11.023,0.000,169.78,169.79,3.490,-12.220*60 [GPS=28906.743s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906743,3.274,-11.023,0.000,169.78,169.79,3.490,-12.220*62 [GPS=28906.767s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906767,3.274,-11.023,0.000,169.78,169.79,3.490,-12.220*65 [GPS=28906.778s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28906778,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*43 [GPS=28906.789s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906789,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*63 [GPS=28906.801s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906801,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*41 [GPS=28906.812s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906812,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28906.830s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906830,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28906.842s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906842,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*6A [GPS=28906.853s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906853,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*47 [GPS=28906.864s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28906864,3.283,-11.068,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28906.876s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906876,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*64 [GPS=28906.898s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906898,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*64 [GPS=28906.909s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906909,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*6D [GPS=28906.909s r=1] STM32 UART5 POSE: $POSE,3.291,-11.114,-0.000,169.79,0.00,-0.00,3.490,-12.220,28906909*10 [GPS=28906.921s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906921,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*66 [GPS=28906.932s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28906932,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*65 [GPS=28906.950s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906950,3.291,-11.114,-0.000,169.80,169.79,3.490,-12.220*66 [GPS=28906.962s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906962,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*4D [GPS=28906.962s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28906962,3.291,-11.114,-0.000,169.79,169.79,3.490,-12.220*4D [GPS=28906.985s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28906985,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28906.997s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28906997,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*64 [GPS=28907.009s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907009,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*6A [GPS=28907.027s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907027,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.038s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907038,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*68 [GPS=28907.050s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907050,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*4B [GPS=28907.062s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907062,3.299,-11.157,-0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.068s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907068,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*6A [GPS=28907.091s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907091,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*6D [GPS=28907.103s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907103,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.114s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907114,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*61 [GPS=28907.126s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907126,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*60 [GPS=28907.144s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907144,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28907.155s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907155,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28907.167s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907167,3.307,-11.201,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28907.167s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907167,3.315,-11.247,0.000,169.79,169.79,3.490,-12.220*65 [GPS=28907.189s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907189,3.315,-11.247,0.000,169.79,169.79,3.490,-12.220*65 [GPS=28907.207s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907207,3.315,-11.247,0.000,169.79,169.79,3.490,-12.220*61 [GPS=28907.219s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907219,3.315,-11.247,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28907.230s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28907230,3.315,-11.247,0.000,169.78,169.79,3.490,-12.220*65 [GPS=28907.242s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907242,3.315,-11.247,0.000,169.78,169.79,3.490,-12.220*61 [GPS=28907.253s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907253,3.315,-11.247,0.000,169.78,169.79,3.490,-12.220*60 [GPS=28907.276s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907276,3.315,-11.247,0.000,169.78,169.79,3.490,-12.220*4B [GPS=28907.287s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28907287,3.323,-11.291,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28907.299s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907299,3.323,-11.291,0.000,169.79,169.79,3.490,-12.220*45 [GPS=28907.299s r=1] STM32 UART5 STATE: $STATE,follow_path,0.000,-0.00,28907299*0F [GPS=28907.305s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907305,3.323,-11.291,0.000,169.79,169.79,3.490,-12.220*40 [GPS=28907.321s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28907321,3.323,-11.291,0.000,169.80,169.79,3.490,-12.220*40 [GPS=28907.339s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907339,3.323,-11.291,0.000,169.80,169.79,3.490,-12.220*49 [GPS=28907.351s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907351,3.323,-11.291,0.000,169.80,169.79,3.490,-12.220*46 [GPS=28907.363s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907363,3.323,-11.291,0.000,169.80,169.79,3.490,-12.220*6A [GPS=28907.374s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907374,3.323,-11.291,0.000,169.80,169.79,3.490,-12.220*40 [GPS=28907.386s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28907386,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*6D [GPS=28907.402s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907402,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*4C [GPS=28907.414s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28907414,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.426s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907426,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.436s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907436,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*66 [GPS=28907.448s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907448,3.331,-11.334,0.000,169.79,169.79,3.490,-12.220*6F [GPS=28907.470s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907470,3.331,-11.334,0.000,169.78,169.79,3.490,-12.220*64 [GPS=28907.470s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907470,3.331,-11.334,0.000,169.78,169.79,3.490,-12.220*64 [GPS=28907.493s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28907493,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*6C [GPS=28907.499s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907499,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28907.511s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28907511,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*64 [GPS=28907.523s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907523,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*48 [GPS=28907.546s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907546,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*4A [GPS=28907.558s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907558,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*44 [GPS=28907.564s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907564,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*66 [GPS=28907.576s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907576,3.339,-11.380,-0.000,169.79,169.79,3.490,-12.220*49 [GPS=28907.599s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28907599,3.347,-11.424,0.000,169.79,169.79,3.490,-12.220*49 [GPS=28907.610s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907610,3.347,-11.424,0.000,169.80,169.79,3.490,-12.220*4D [GPS=28907.621s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907621,3.347,-11.424,0.000,169.79,169.79,3.490,-12.220*65 [GPS=28907.627s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907627,3.347,-11.424,0.000,169.80,169.79,3.490,-12.220*49 [GPS=28907.639s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907639,3.347,-11.424,0.000,169.80,169.79,3.490,-12.220*47 [GPS=28907.661s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907661,3.347,-11.424,0.000,169.80,169.79,3.490,-12.220*67 [GPS=28907.673s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907673,3.347,-11.424,0.000,169.80,169.79,3.490,-12.220*49 [GPS=28907.684s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28907684,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*67 [GPS=28907.694s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907694,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*4C [GPS=28907.717s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907717,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*6B [GPS=28907.723s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907723,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*6C [GPS=28907.735s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907735,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*46 [GPS=28907.747s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907747,3.355,-11.469,0.000,169.78,169.79,3.490,-12.220*6E [GPS=28907.758s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907758,3.355,-11.469,0.000,169.78,169.79,3.490,-12.220*61 [GPS=28907.770s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907770,3.355,-11.469,0.000,169.79,169.79,3.490,-12.220*47 [GPS=28907.787s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28907787,3.363,-11.512,0.000,169.79,169.79,3.490,-12.220*45 [GPS=28907.799s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907799,3.363,-11.512,0.000,169.79,169.79,3.490,-12.220*48 [GPS=28907.811s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907811,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*40 [GPS=28907.823s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28907823,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*41 [GPS=28907.841s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907841,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*69 [GPS=28907.852s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28907852,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*46 [GPS=28907.863s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907863,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*69 [GPS=28907.874s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907874,3.363,-11.512,0.000,169.80,169.79,3.490,-12.220*6F [GPS=28907.886s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.004,76.92,1502,1231,follow_path,28907886,3.371,-11.558,0.000,169.79,169.79,3.490,-12.220*6E [GPS=28907.909s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.002,76.92,1501,1231,follow_path,28907909,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*6C [GPS=28907.909s r=1] STM32 UART5 POSE: $POSE,3.371,-11.558,0.000,169.78,0.00,-0.00,3.490,-12.220,28907909*3E [GPS=28907.920s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28907920,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*64 [GPS=28907.931s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907931,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*65 [GPS=28907.942s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907942,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*60 [GPS=28907.954s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28907954,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*67 [GPS=28907.972s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907972,3.371,-11.558,0.000,169.78,169.79,3.490,-12.220*62 [GPS=28907.972s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.006,76.92,1497,1231,follow_path,28907972,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*6F [GPS=28907.995s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28907995,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*43 [GPS=28908.005s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.002,76.92,1499,1231,follow_path,28908005,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*63 [GPS=28908.017s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1510,1231,follow_path,28908017,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*63 [GPS=28908.039s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28908039,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*6E [GPS=28908.050s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28908050,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*61 [GPS=28908.062s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28908062,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*4C [GPS=28908.068s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28908068,3.379,-11.604,-0.000,169.80,169.79,3.490,-12.220*46 [GPS=28908.080s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28908080,3.379,-11.604,-0.000,169.79,169.79,3.490,-12.220*46 [GPS=28908.103s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.003,76.92,1501,1231,follow_path,28908103,3.387,-11.647,-0.000,169.79,169.79,3.490,-12.220*48 [GPS=28908.114s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28908114,3.387,-11.647,-0.000,169.79,169.79,3.490,-12.220*4C [GPS=28908.126s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28908126,3.387,-11.647,-0.000,169.78,169.79,3.490,-12.220*4C [GPS=28908.132s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1510,1231,follow_path,28908132,3.387,-11.647,-0.000,169.78,169.79,3.490,-12.220*49 [GPS=28908.144s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.001,76.92,1501,1231,follow_path,28908144,3.387,-11.647,-0.000,169.78,169.79,3.490,-12.220*48 [GPS=28908.167s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28908167,3.387,-11.647,-0.000,169.78,169.79,3.490,-12.220*48 [GPS=28908.167s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28908167,3.387,-11.647,-0.000,169.78,169.79,3.490,-12.220*48 [GPS=28908.189s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.005,76.92,1498,1231,follow_path,28908189,3.395,-11.693,0.000,169.80,169.79,3.490,-12.220*41 [GPS=28908.201s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.000,76.92,1510,1231,follow_path,28908201,3.395,-11.693,0.000,169.80,169.79,3.490,-12.220*46 [GPS=28908.213s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1499,1231,follow_path,28908213,3.395,-11.693,0.000,169.80,169.79,3.490,-12.220*44 [GPS=28908.231s r=1] STM32 UART5 CTRL: $CTRL,0.450,0.001,76.92,1500,1231,follow_path,28908231,3.395,-11.693,0.000,169.80,169.79,3.490,-12.220*45 [GPS=28908.242s r=1] STM32 UART5 CTRL: $CTRL,0.450,-0.000,76.92,1510,1231,follow_path,28908242,3.395,-11.693,0.000,169.80,169.79,3.490,-12.220*6C