pathfollowing.txt

关于机器人路径规划的算法实现

-7.758 -0.447 -7.758 -0.447 -0.005 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.080 -7.800 -0.450 -7.550 -0.400 0.107647 0.107746
-7.747 -0.443 -7.747 -0.443 -0.004 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.074 -7.800 -0.450 -7.550 -0.400 0.107946 0.108029
-7.742 -0.439 -7.742 -0.439 -0.001 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.077 -7.800 -0.450 -7.550 -0.400 0.108909 0.109028
-7.742 -0.439 -7.742 -0.439 -0.001 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.077 -7.800 -0.450 -7.550 -0.400 0.105416 0.109028
-7.744 -0.439 -7.742 -0.439 0.000 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.076 -7.800 -0.450 -7.550 -0.400 0.111365 0.109028
-7.744 -0.439 -7.742 -0.439 0.000 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.076 -7.800 -0.450 -7.550 -0.400 0.103649 0.109028
-7.745 -0.443 -7.745 -0.443 -0.004 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.072 -7.800 -0.450 -7.550 -0.400 0.103252 0.424041
-7.745 -0.443 -7.745 -0.443 -0.004 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.072 -7.800 -0.450 -7.550 -0.400 0.1004 0.424041
-7.747 -0.444 -7.747 -0.444 -0.005 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.072 -7.800 -0.450 -7.550 -0.400 0.103035 0.203612
-7.750 -0.447 -7.750 -0.447 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.067 -7.800 -0.450 -7.550 -0.400 0.102248 0.102324
-7.751 -0.447 -7.750 -0.447 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.067 -7.800 -0.450 -7.550 -0.400 0.100718 0.102324
-7.754 -0.451 -7.754 -0.451 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.067 -7.800 -0.450 -7.550 -0.400 0.103231 0.204097
-7.755 -0.451 -7.755 -0.451 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.067 -7.800 -0.450 -7.550 -0.400 0.101724 0.101809
-7.756 -0.451 -7.755 -0.451 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.066 -7.800 -0.450 -7.550 -0.400 0.100375 0.101809
-7.757 -0.451 -7.757 -0.451 -0.009 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.063 -7.800 -0.450 -7.550 -0.400 0.103495 0.204075
-7.757 -0.450 -7.757 -0.450 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.063 -7.800 -0.450 -7.550 -0.400 0.102022 0.10211
-7.759 -0.450 -7.757 -0.450 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.061 -7.800 -0.450 -7.550 -0.400 0.100479 0.10211
-7.760 -0.451 -7.760 -0.451 -0.009 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.063 -7.800 -0.450 -7.550 -0.400 0.103249 0.203971
-7.759 -0.451 -7.759 -0.451 -0.009 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.059 -7.800 -0.450 -7.550 -0.400 0.101641 0.101728
-7.760 -0.451 -7.759 -0.451 -0.009 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.057 -7.800 -0.450 -7.550 -0.400 0.099045 0.101728
-7.758 -0.448 -7.758 -0.448 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.059 -7.800 -0.450 -7.550 -0.400 0.101744 0.200986
-7.760 -0.448 -7.758 -0.448 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.058 -7.800 -0.450 -7.550 -0.400 0.103438 0.200986
-7.759 -0.447 -7.759 -0.447 -0.005 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.060 -7.800 -0.450 -7.550 -0.400 0.103283 0.206921
-7.763 -0.449 -7.763 -0.449 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.055 -7.800 -0.450 -7.550 -0.400 0.101934 0.102027
-7.767 -0.450 -7.767 -0.450 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.054 -7.800 -0.450 -7.550 -0.400 0.102163 0.102252
-7.769 -0.451 -7.769 -0.451 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.049 -7.800 -0.450 -7.550 -0.400 0.099229 0.099287
-7.770 -0.451 -7.770 -0.451 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.051 -7.800 -0.450 -7.550 -0.400 0.101137 0.10127
-7.771 -0.452 -7.771 -0.452 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.048 -7.800 -0.450 -7.550 -0.400 0.104551 0.104642
-7.771 -0.452 -7.771 -0.452 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.045 -7.800 -0.450 -7.550 -0.400 0.10108 0.104642
-7.773 -0.451 -7.773 -0.451 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.048 -7.800 -0.450 -7.550 -0.400 0.103139 0.204419
-7.772 -0.452 -7.772 -0.452 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.045 -7.800 -0.450 -7.550 -0.400 0.102119 0.102207
-7.769 -0.452 -7.772 -0.452 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.043 -7.800 -0.450 -7.550 -0.400 0.100258 0.102207
-7.770 -0.452 -7.770 -0.452 -0.008 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.040 -7.800 -0.450 -7.550 -0.400 0.10573 0.206205
-7.763 -0.452 -7.763 -0.452 -0.009 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.041 -7.800 -0.450 -7.550 -0.400 0.099071 0.099173
-7.757 -0.452 -7.757 -0.452 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.037 -7.800 -0.450 -7.550 -0.400 0.102291 0.102404
-7.749 -0.450 -7.749 -0.450 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.033 -7.800 -0.450 -7.550 -0.400 0.101577 0.101688
-7.742 -0.450 -7.742 -0.450 -0.011 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.029 -7.800 -0.450 -7.550 -0.400 0.101815 0.101913
-7.732 -0.449 -7.732 -0.449 -0.012 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.024 -7.800 -0.450 -7.550 -0.400 0.102087 0.102222
-7.722 -0.448 -7.722 -0.448 -0.013 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.020 -7.800 -0.450 -7.550 -0.400 0.105231 0.105341
-7.715 -0.447 -7.715 -0.447 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.020 -7.800 -0.450 -7.550 -0.400 0.10144 0.101546
-7.707 -0.445 -7.707 -0.445 -0.013 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.014 -7.800 -0.450 -7.550 -0.400 0.098789 0.098905
-7.697 -0.443 -7.707 -0.445 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.012 -7.800 -0.450 -7.550 -0.400 0.100293 0.098905
-7.688 -0.442 -7.688 -0.442 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.008 -7.800 -0.450 -7.550 -0.400 0.100924 0.201452
-7.675 -0.440 -7.675 -0.440 -0.015 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.003 -7.800 -0.450 -7.550 -0.400 0.104548 0.104665
-7.665 -0.438 -7.675 -0.440 -0.015 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.001 -7.800 -0.450 -7.550 -0.400 0.101474 0.104665
-7.665 -0.438 -7.665 -0.438 -0.015 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.002 -7.800 -0.450 -7.550 -0.400 0.103934 0.205637
-7.656 -0.436 -7.656 -0.436 -0.015 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.002 -7.800 -0.450 -7.550 -0.400 0.100155 0.100266
-7.647 -0.434 -7.647 -0.434 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.001 -7.800 -0.450 -7.550 -0.400 0.102334 0.102523
-7.637 -0.432 -7.637 -0.432 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 0.001 -7.800 -0.450 -7.550 -0.400 0.106518 0.106623
-7.616 -0.427 -7.616 -0.427 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.004 -7.800 -0.450 -7.550 -0.400 0.097979 0.098094
-7.607 -0.426 -7.607 -0.426 -0.014 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.004 -7.800 -0.450 -7.550 -0.400 0.102512 0.102618
-7.596 -0.422 -7.596 -0.422 -0.013 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.005 -7.800 -0.450 -7.550 -0.400 0.101389 0.10143
-7.589 -0.421 -7.589 -0.421 -0.013 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.005 -7.800 -0.450 -7.550 -0.400 0.102075 0.102223
-7.582 -0.419 -7.582 -0.419 -0.012 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.011 -7.800 -0.450 -7.550 -0.400 0.10065 0.100795
-7.575 -0.418 -7.575 -0.418 -0.013 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.012 -7.800 -0.450 -7.550 -0.400 0.101337 0.101465
-7.569 -0.415 -7.569 -0.415 -0.011 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.013 -7.800 -0.450 -7.550 -0.400 0.101756 0.101895
-7.555 -0.411 -7.555 -0.411 -0.010 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.014 -7.800 -0.450 -7.550 -0.400 0.101849 0.101988
-7.544 -0.409 -7.544 -0.409 0.011 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.018 -7.800 -0.450 -7.550 -0.400 0.102095 0.102234
-7.525 -0.404 -7.525 -0.404 -0.007 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.030 -7.550 -0.400 -7.150 -0.350 0.203346 0.203033
-7.515 -0.402 -7.515 -0.402 -0.006 2563514400221702101585699298908980192004522167964920773888484555307034996564809325297907664343910114193172143549941382488729025596154602403307483564603021995524144820651124850688.000 -0.030 -7.550 -0.400 -7.150 -0.350 0.101759 0.101904