This should not happen.
[ERROR] [1756358664.429886169, 3672.712000000]: Ran out of pool, index=100 61 26
[ERROR] [1756358664.429899881, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.429913079, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.429953628, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.429974423, 3672.712000000]: Ran out of pool, index=100 62 26
[ERROR] [1756358664.429987496, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430000376, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.430036663, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.430052404, 3672.712000000]: Ran out of pool, index=100 60 26
[ERROR] [1756358664.430065756, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430083399, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.430115088, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.430131173, 3672.712000000]: Ran out of pool, index=100 62 26
[ERROR] [1756358664.430149486, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430162703, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.430235732, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.430268589, 3672.712000000]: Ran out of pool, index=100 60 26
[ERROR] [1756358664.430290943, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430306426, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.430344630, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.430366767, 3672.712000000]: Ran out of pool, index=100 61 26
[ERROR] [1756358664.430384512, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430403036, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.430435337, 3672.712000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.430456490, 3672.712000000]: Ran out of pool, index=100 60 26
[ERROR] [1756358664.430474754, 3672.712000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.430488073, 3672.712000000]: a star error
iter=5,time(ms)=0,rebound.
-0.0924 0.573 -0.0117
-0.0929 0.573 -0.0114
-0.22 0.545 0.0515
-0.507 0.508 0.193
[WARN] [1756358664.430557163, 3672.712000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1361
start: -0.0919 0.574 -0.012, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.092 0.57 -0.012
-0.092 0.57 -0.011
-0.15 0.56 0.13
-0.29 0.6 0.38
[WARN] [1756358664.430915790, 3672.712000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1362
start: -0.0919 0.574 -0.012, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.092 0.57 -0.012
-0.092 0.57 -0.012
-0.13 0.67 0.11
-0.25 0.86 0.29
[WARN] [1756358664.455403672, 3672.728000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1363
start: -0.0919 0.574 -0.012, 0 0 0
goal:-2.99 3.55 1, 0 0 0
[ERROR] [1756358664.491644334, 3672.732000000]: Ran out of pool, index=100 23 26
[ERROR] [1756358664.491745147, 3672.732000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.491804661, 3672.732000000]: a star error, force return!
[ERROR] [1756358664.491914622, 3672.732000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.492054906, 3672.732000000]: Ran out of pool, index=100 23 26
[ERROR] [1756358664.492110003, 3672.732000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.492137217, 3672.732000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.492199114, 3672.732000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.492255540, 3672.732000000]: Ran out of pool, index=100 23 26
[ERROR] [1756358664.492307602, 3672.732000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.492328030, 3672.732000000]: a star error
-0.0922 0.574 -0.0119
-0.0924 0.574 -0.0117
-0.161 0.609 0.0238
-0.328 0.704 0.107
[WARN] [1756358664.492497334, 3672.732000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1364
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
[ERROR] [1756358664.500685781, 3672.744000000]: Ran out of pool, index=100 40 27
[ERROR] [1756358664.500790285, 3672.744000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.500841994, 3672.744000000]: a star error, force return!
[ERROR] [1756358664.500946032, 3672.744000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.501024860, 3672.744000000]: Ran out of pool, index=100 40 27
[ERROR] [1756358664.501101501, 3672.744000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.501179159, 3672.744000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.501306925, 3672.744000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.501378965, 3672.744000000]: Ran out of pool, index=100 40 27
[ERROR] [1756358664.501428880, 3672.744000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.501500788, 3672.744000000]: a star error
iter=5,time(ms)=0,rebound.
-0.0852 0.58 -0.00752
-0.0856 0.58 -0.00734
-0.173 0.595 0.0351
-0.381 0.644 0.133
[WARN] [1756358664.501692241, 3672.744000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1365
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0073
-0.085 0.58 -0.007
-0.11 0.58 0.15
-0.17 0.68 0.4
[WARN] [1756358664.507642672, 3672.752000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1366
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0078
-0.084 0.58 -0.008
-0.25 0.71 0.055
-0.54 0.98 0.15
[WARN] [1756358664.516889884, 3672.764000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1367
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0075
-0.084 0.58 -0.0074
-0.11 0.63 0.16
-0.19 0.77 0.44
[WARN] [1756358664.522673491, 3672.772000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1368
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0074
-0.086 0.58 -0.0071
-0.11 0.61 0.15
-0.24 0.68 0.4
[WARN] [1756358664.555013954, 3672.788000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1369
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0079
-0.085 0.58 -0.0082
-0.19 0.66 0.12
-0.39 0.82 0.29
[WARN] [1756358664.561977705, 3672.792000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1370
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0079
-0.085 0.58 -0.008
-0.22 0.65 0.096
-0.47 0.8 0.23
[WARN] [1756358664.576167822, 3672.804000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1371
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
-0.085 0.58 -0.0074
-0.084 0.58 -0.0071
-0.094 0.59 0.14
-0.15 0.68 0.4
[WARN] [1756358664.585455552, 3672.812000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1372
start: -0.0849 0.58 -0.00768, 0 0 0
goal:-2.99 3.55 1, 0 0 0
[ERROR] [1756358664.645594342, 3672.824000000]: Ran out of pool, index=100 3 10
[ERROR] [1756358664.645641009, 3672.824000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.645659474, 3672.824000000]: a star error, force return!
[ERROR] [1756358664.645708497, 3672.824000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.645728158, 3672.824000000]: Ran out of pool, index=100 3 10
[ERROR] [1756358664.645742831, 3672.824000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.645756807, 3672.824000000]: a star error
iter=5,time(ms)=0,rebound.
[ERROR] [1756358664.645796326, 3672.824000000]: ERROR! the drone is in obstacle. This should not happen.
[ERROR] [1756358664.645815082, 3672.824000000]: Ran out of pool, index=100 3 10
[ERROR] [1756358664.645835116, 3672.824000000]: Unable to handle the initial or end point, force return!
[ERROR] [1756358664.645849149, 3672.824000000]: a star error
-0.0851 0.58 -0.00751
-0.0852 0.581 -0.00732
-0.137 0.629 0.0375
-0.266 0.754 0.141
[WARN] [1756358664.645906536, 3672.824000000]: First 3 control points in obstacles! return false, t=0.000000
first_optimize_step_success=0
final_plan_success=0
[FSM]: from GEN_NEW_TRAJ to GEN_NEW_TRAJ
[rebo replan]: -------------------------------------1373
start: -0.085 0.579 -0.00401, 0 0 0
goal:-2.99 3.55 1, 0 0 0
iter(+1)=24,time(ms)=0.000,total_t(ms)=0.000,cost=0.053
first_optimize_step_success=1
Need to reallocate time.
total time:0,optimize:0,refine:0
final_plan_success=1
[FSM]: from GEN_NEW_TRAJ to EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[rebo replan]: -------------------------------------1374
start: -0.0872 0.578 -0.00241, -0.00322 -0.000964 0.00222
goal:-2.99 3.55 1, 0 0 0
iter(+1)=21,time(ms)=0.000,total_t(ms)=0.000,cost=0.028
first_optimize_step_success=1
total time:0,optimize:0,refine:0
final_plan_success=1
[SAFETY]: from EXEC_TRAJ to EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: from EXEC_TRAJ to REPLAN_TRAJ
[rebo replan]: -------------------------------------1375
start: -1.38 1.07 0.73, -0.228 0.188 0.1
goal:-2.99 3.55 1, 0 0 0
iter(+1)=15,time(ms)=0.000,total_t(ms)=0.000,cost=0.013
first_optimize_step_success=1
total time:0,optimize:0,refine:0
final_plan_success=1
[FSM]: from REPLAN_TRAJ to EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: state: EXEC_TRAJ
[FSM]: from EXEC_TRAJ to WAIT_TARGET
[FSM]: state: WAIT_TARGET
[FSM]: state: WAIT_TARGET
[FSM]: state: WAIT_TARGET
[FSM]: state: WAIT_TARGET
[FSM]: state: WAIT_TARGET
[FSM]: state: WAIT_TARGET
^C[traj_server-2] killing on exit
[waypoint_generator-3] killing on exit
[ego_planner_node-1] killing on exit
des manager
shutting down processing monitor...
... shutting down processing monitor complete
done