Wrong value for dist - Githubissues

HuaYuXiao / Fast-Planner

[RA-L 2019] A Robust and Efficient Trajectory Planner for Quadrotors

GNU General Public License v3.0

1 stars 0 forks source link

Wrong value for dist #46

Open HuaYuXiao opened 2 months ago

HuaYuXiao commented 2 months ago

origin_: -8 -5  0
map size: 16 10  3
resolution: 0.05
[0m[ INFO] [1713971293.196200975]: global_point_sdf: sub pub finished![0m
[0m[ INFO] [1713971293.224162366]: global_point_sdf: init sdf_tools finished![0m
[0m[ INFO] [1713971293.224210129]: --- EDTEnvironment: set global sdf_map finished! ---[0m
margin:0.1
origin_: -8 -5  0
map size: 16 10  3
lamda1: 10
lamda2: 0.6
lamda3: 1e-05
lamda4: 0.001
[FSM] state: INIT
[fsm] no map.
[FSM] state: INIT
[fsm] no map.
[FSM] state: INIT
[fsm] no map.
[FSM]: from INIT to WAIT_GOAL
[fsm] Get a new goal: (1.02959, 0.0680208, 1.57349)
[TRIG]: from WAIT_GOAL to GEN_NEW_TRAJ
[planner]: -----------------------
start: (pt; vel; acc) -0.0141311  0.0168889    1.57349, 0.00188366 0.00172531 -0.0814214, 0 0 0
goal:  1.02959 0.0680208   1.57349, 0 0 0
cur pos: -0.0141311  0.0168889    1.57349
time: 2.01733e+267
dist: 0.291548
cur pos: -0.013566 0.0174065   1.54907
time: 0
dist: 0.291548
cur pos:  0.147941 0.0187867   1.52393
time: 0
dist: 0.25
[Kino Astar]: near end.
[planner]: init search success.
[Optimization]: begin-------------