Copy plot path form iamcar2 repository

[hubacji1/path-to-traj.git] / pe1.json

{
        "bcnt" : 4,
        "entry" : 
        [
                11.25,
                3.0665835386367766,
                -1.5707963267948966,
                -1.5707963267948966
        ],
        "goal" : 
        [
                11.25,
                5.8665835386367711,
                -1.5707963267948966
        ],
        "goal_cc" : 17.257640714274341,
        "icnt" : 48,
        "init" : 
        [
                0,
                0,
                0
        ],
        "ispath" : 
        [
                [
                        11.25,
                        3.1665835386367767,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.2665835386367768,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.3665835386367768,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.4665835386367769,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.566583538636777,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.6665835386367771,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.7665835386367772,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.8665835386367773,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        3.9665835386367774,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.0665835386367775,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.1665835386367771,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.2665835386367768,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.3665835386367764,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.466583538636776,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.5665835386367757,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.6665835386367753,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.766583538636775,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.8665835386367746,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        4.9665835386367743,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.0665835386367739,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.1665835386367736,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.2665835386367732,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.3665835386367728,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.4665835386367725,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.5665835386367721,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.6665835386367718,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.7665835386367714,
                        -1.5707963267948966
                ],
                [
                        11.25,
                        5.8665835386367711,
                        -1.5707963267948966
                ]
        ],
        "log_path_cost" : 
        [
                0.0,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                21.106439728964382,
                20.822250719147934,
                20.822250719147934,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                18.161403726533752,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341,
                17.257640714274341
        ],
        "ncnt" : 6,
        "obst" : 
        [
                [
                        [
                                10,
                                2
                        ],
                        [
                                10,
                                7
                        ],
                        [
                                9,
                                7
                        ],
                        [
                                9,
                                2
                        ]
                ],
                [
                        [
                                10,
                                7
                        ],
                        [
                                12.5,
                                7
                        ],
                        [
                                12.5,
                                8
                        ],
                        [
                                10,
                                8
                        ]
                ],
                [
                        [
                                12.5,
                                7
                        ],
                        [
                                12.5,
                                2
                        ],
                        [
                                13.5,
                                2
                        ],
                        [
                                13.5,
                                7
                        ]
                ]
        ],
        "ogoal_cc" : 18.119786458091308,
        "opath" : 
        [
                [
                        0.0,
                        0.0,
                        0.0,
                        0.0
                ],
                [
                        0.0,
                        0.0,
                        0.0,
                        0.0
                ],
                [
                        0.4986892401969264,
                        -0.031325161923024473,
                        -0.1254651455172934,
                        0.1254651455172934
                ],
                [
                        0.98953865467239843,
                        -0.12480818908185064,
                        -0.25093029103458681,
                        0.25093029103458681
                ],
                [
                        1.4648316665388816,
                        -0.27897944752057025,
                        -0.37639543655188018,
                        0.37639543655188018
                ],
                [
                        1.9170962589985263,
                        -0.49141523185316083,
                        -0.50186058206917361,
                        0.50186058206917361
                ],
                [
                        2.3392224419030225,
                        -0.75877586800622498,
                        -0.62732572758646699,
                        0.62732572758646699
                ],
                [
                        2.3392224419030225,
                        -0.75877586800622498,
                        -0.62732572758646699,
                        0.0
                ],
                [
                        2.761348624807519,
                        -1.0261365041592891,
                        -0.50186058206917361,
                        0.1254651455172934
                ],
                [
                        3.2136132172671634,
                        -1.2385722884918797,
                        -0.37639543655188018,
                        0.25093029103458681
                ],
                [
                        3.6889062291336465,
                        -1.3927435469305993,
                        -0.25093029103458681,
                        0.37639543655188018
                ],
                [
                        4.179755643609119,
                        -1.4862265740894256,
                        -0.12546514551729337,
                        0.50186058206917361
                ],
                [
                        4.6784448838060451,
                        -1.51755173601245,
                        0.0,
                        0.62732572758646699
                ],
                [
                        5.1771341240029711,
                        -1.4862265740894256,
                        0.12546514551729337,
                        0.75279087310376036
                ],
                [
                        5.6679835384784436,
                        -1.3927435469305993,
                        0.25093029103458686,
                        0.87825601862105385
                ],
                [
                        6.1432765503449271,
                        -1.2385722884918797,
                        0.37639543655188024,
                        1.0037211641383472
                ],
                [
                        6.1432765503449271,
                        -1.2385722884918797,
                        0.37639543655188024,
                        0.0
                ],
                [
                        6.6185695622114107,
                        -1.0844010300531601,
                        0.25093029103458686,
                        0.1254651455172934
                ],
                [
                        7.1094189766868823,
                        -0.99091800289433396,
                        0.12546514551729343,
                        0.25093029103458681
                ],
                [
                        7.6081082168838083,
                        -0.95959284097130948,
                        5.5511151231257827e-17,
                        0.37639543655188018
                ],
                [
                        8.1067974570807344,
                        -0.99091800289433396,
                        -0.12546514551729337,
                        0.50186058206917361
                ],
                [
                        8.5976468715562078,
                        -1.0844010300531601,
                        -0.25093029103458675,
                        0.62732572758646699
                ],
                [
                        8.5976468715562078,
                        -1.0844010300531601,
                        -0.25093029103458675,
                        0.0
                ],
                [
                        9.0729398834226913,
                        -1.2385722884918797,
                        -0.37639543655188012,
                        0.1254651455172934
                ],
                [
                        9.5252044758823349,
                        -1.4510080728244703,
                        -0.5018605820691735,
                        0.25093029103458681
                ],
                [
                        9.9473306587868322,
                        -1.7183687089775344,
                        -0.62732572758646699,
                        0.37639543655188018
                ],
                [
                        10.332682243825545,
                        -2.036451056752199,
                        -0.75279087310376036,
                        0.50186058206917361
                ],
                [
                        10.675201171139401,
                        -2.4002545868195382,
                        -0.87825601862105374,
                        0.62732572758646699
                ],
                [
                        10.957260986605135,
                        -2.784898008008887,
                        -1.003721164138347,
                        -0.0028528984671852831
                ],
                [
                        10.715803436737744,
                        -2.3474388948683234,
                        -1.1291863096556405,
                        -0.12831804398447877
                ],
                [
                        10.530985834421868,
                        -1.8832033103512567,
                        -1.254651455172934,
                        -0.25378318950177214
                ],
                [
                        10.405713672047598,
                        -1.3994894389440318,
                        -1.3801166006902272,
                        -0.37924833501906541
                ],
                [
                        10.341956336242118,
                        -0.90390168063206611,
                        -1.5055817462075207,
                        -0.50471348053635889
                ],
                [
                        10.340716147410379,
                        -0.40423110316191613,
                        -1.6310468917248142,
                        -0.63017862605365238
                ],
                [
                        10.402012602392336,
                        0.091667040275157374,
                        -1.7565120372421075,
                        -0.75564377157094564
                ],
                [
                        10.524882067955772,
                        0.57599680241026219,
                        -1.881977182759401,
                        -0.88110891708823913
                ],
                [
                        10.707392929943293,
                        1.0411441009236087,
                        -2.0074423282766944,
                        -1.0065740626055326
                ],
                [
                        10.925323077030455,
                        1.4910294444524812,
                        -1.9772498141376287,
                        -0.077828829828179513
                ],
                [
                        11.09370892522351,
                        1.9614743723515899,
                        -1.8517846686203352,
                        -0.203293975345473
                ],
                [
                        11.201901480300879,
                        2.4492925711547109,
                        -1.7263195231030417,
                        -0.32875912086276649
                ],
                [
                        11.248199861818806,
                        2.9468151173036374,
                        -1.6008543775857487,
                        -0.45422426638005953
                ],
                [
                        11.25,
                        3.0665835386367766,
                        -1.5707963267948966,
                        0.0
                ]
        ],
        "otime" : 0.00011905300000000091,
        "path" : 
        [
                [
                        0.0,
                        0.0,
                        0.0,
                        0.0,
                        0
                ],
                [
                        0.0,
                        0.0,
                        0.0,
                        0.0,
                        0
                ],
                [
                        0.49905815384987107,
                        0.02750190706077749,
                        0.081558928815441134,
                        0.043906216701852269,
                        0
                ],
                [
                        0.99739611074533863,
                        0.068236176628932638,
                        0.081558928815441134,
                        0.16937136221914567,
                        0
                ],
                [
                        1.495734067640806,
                        0.1089704461970878,
                        0.081558928815441134,
                        0.29483650773643905,
                        0
                ],
                [
                        1.994072024536274,
                        0.14970471576524297,
                        0.081558928815441134,
                        0.42030165325373248,
                        0
                ],
                [
                        2.4924099814317415,
                        0.19043898533339812,
                        0.081558928815441134,
                        0.54576679877102585,
                        0
                ],
                [
                        2.9907479383272086,
                        0.23117325490155327,
                        0.081558928815441134,
                        0.67123194428831923,
                        0
                ],
                [
                        3.4890858952226766,
                        0.27190752446970845,
                        0.081558928815441134,
                        0.79669708980561271,
                        0
                ],
                [
                        3.9874238521181442,
                        0.31264179403786357,
                        0.081558928815441134,
                        0.92216223532290609,
                        0
                ],
                [
                        4.4857618090136109,
                        0.3533760636060187,
                        0.081558928815441134,
                        1.0476273808401992,
                        0
                ],
                [
                        4.9840997659090789,
                        0.39411033317417388,
                        0.081558928815441134,
                        1.1730925263574927,
                        0
                ],
                [
                        5.4824377228045469,
                        0.43484460274232906,
                        0.081558928815441134,
                        1.2985576718747862,
                        0
                ],
                [
                        5.9814954618299421,
                        0.46235667459683971,
                        3.1314480106847675e-05,
                        0.081527614335334286,
                        -1
                ],
                [
                        6.4801856827135227,
                        0.43104712888346308,
                        -0.12543383103718664,
                        0.20699275985262777,
                        -1
                ],
                [
                        6.9710380243207259,
                        0.33757947246469411,
                        -0.25089897655448012,
                        0.33245790536992126,
                        -1
                ],
                [
                        7.4463358637469765,
                        0.1834230976551274,
                        -0.37636412207177317,
                        0.4579230508872143,
                        -1
                ],
                [
                        7.898607108301019,
                        -0.028998524142725315,
                        -0.50182926758906665,
                        0.58338819640450779,
                        -1
                ],
                [
                        8.3207416632578681,
                        -0.29634594150274823,
                        -0.62729441310636014,
                        0.70885334192180127,
                        -1
                ],
                [
                        8.706103208690994,
                        -0.61441622203691448,
                        -0.75275955862365318,
                        0.83431848743909431,
                        -1
                ],
                [
                        9.0486335281553156,
                        -0.97820902612374783,
                        -0.87822470414094667,
                        0.9597836329563878,
                        -1
                ],
                [
                        9.3429477490839954,
                        -1.3820052165674379,
                        -1.0036898496582403,
                        1.0852487784736813,
                        -1
                ],
                [
                        9.5844189976376928,
                        -1.8194567683758758,
                        -1.1291549951755337,
                        1.2107139239909748,
                        -1
                ],
                [
                        9.7554383401516169,
                        -2.2422353917972098,
                        -1.2436564329773121,
                        0.78461794280159292,
                        -1
                ],
                [
                        9.8146117510260353,
                        -2.4082092581615067,
                        -1.3691215784946054,
                        -0.040690315129129573,
                        1
                ],
                [
                        9.7454093803957704,
                        -1.9133524546750402,
                        -1.4945867240118988,
                        -0.16615546064642306,
                        1
                ],
                [
                        9.7386754881295339,
                        -1.4137257152458556,
                        -1.6200518695291923,
                        -0.29162060616371654,
                        1
                ],
                [
                        9.7945159368318091,
                        -0.91718360389333431,
                        -1.7455170150464856,
                        -0.41708575168100981,
                        1
                ],
                [
                        9.9120528664030658,
                        -0.43153219161838463,
                        -1.8709821605637791,
                        -0.54255089719830329,
                        1
                ],
                [
                        10.089438494758994,
                        0.035593661777104713,
                        -1.9964473060810726,
                        -0.66801604271559678,
                        1
                ],
                [
                        10.323884166561349,
                        0.47685033428283924,
                        -2.1219124515983658,
                        -0.79348118823289004,
                        1
                ],
                [
                        10.603781512503618,
                        0.89104144381839245,
                        -2.1482704759948055,
                        -0.049553560560426924,
                        -1
                ],
                [
                        10.849775056450756,
                        1.3259660354363183,
                        -2.022805330477512,
                        -0.17501870607772041,
                        -1
                ],
                [
                        11.039410158457226,
                        1.7882546380912887,
                        -1.8973401849602189,
                        -0.30048385159501345,
                        -1
                ],
                [
                        11.169705590875505,
                        2.2706396755340208,
                        -1.7718750394429255,
                        -0.42594899711230694,
                        -1
                ],
                [
                        11.238612996933227,
                        2.7655376381971211,
                        -1.646409893925632,
                        -0.55141414262960042,
                        -1
                ],
                [
                        11.25,
                        3.0665835386367766,
                        -1.5707963267948966,
                        0.0,
                        0
                ]
        ],
        "rcnt" : 9,
        "slot" : 
        [
                [
                        10,
                        2
                ],
                [
                        10,
                        7
                ],
                [
                        12.5,
                        7
                ],
                [
                        12.5,
                        2
                ]
        ],
        "time" : 0.036454897
}