forked from yuxiangdai/TellORB
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathoutput7.txt
1139 lines (1139 loc) · 51.6 KB
/
output7.txt
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
starting mono pub
Using params:
scale_factor: 45.000000
resize_factor: 0.750000
cloud_max: 29.000000, 48.000000 cloud_min: -25.000000, -12.000000
free_thresh: 0.650000
occupied_thresh: 0.400000
use_local_counters: 1
visit_thresh: 30
use_gaussian_counters: 1
use_boundary_detection: 1
use_height_thresholding: 1
normal_thresh_deg: 80.000000
canny_thresh: 300
enable_goal_publishing: 0
show_camera_location: 1
gaussian_kernel_size: 3
cam_radius: 3
normal_thresh_y_rad: 0.174533 rad
grid_max: 1305.000000, 2160.000000 grid_min: -1125.000000, -540.000000
grid_size: (2700, 2430)
output_size: (2025, 1822)
norm_factor_x_us: 0.981481
norm_factor_z_us: 0.983333
norm_factor_x: 0.999588
norm_factor_z: 0.999630
The blue dot is1124539
The blue dot is1124538
The blue dot is1124538
The blue dot is1124538
The blue dot is1125537
The blue dot is1125536
The blue dot is1125536
The blue dot is1125536
The blue dot is1125535
The blue dot is1125535
The blue dot is1125535
The blue dot is1125535
The blue dot is1125535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124535
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124536
The blue dot is1124537
The blue dot is1124537
The blue dot is1124537
The blue dot is1124537
The blue dot is1124538
The blue dot is1124538
The blue dot is1124538
The blue dot is1124538
The blue dot is1124539
The blue dot is1124539
The blue dot is1124539
The blue dot is1124539
The blue dot is1124539
The blue dot is1124540
The blue dot is1124540
The blue dot is1124541
The blue dot is1124541
The blue dot is1124541
The blue dot is1125541
The blue dot is1125541
The blue dot is1125542
The blue dot is1125544
The blue dot is1125546
The blue dot is1125549
The blue dot is1125553
The blue dot is1125557
The blue dot is1125559
The blue dot is1125563
The blue dot is1125564
The blue dot is1125565
The blue dot is1125566
initialPose x: 25.0252
initialPose y: 12.5957
The blue dot is1125562
The blue dot is1125558
The blue dot is1125559
newPose x: 25.0183
newPose y: 12.4381
Calculated scale: 0.00315446
setting the mode to dfs now
The blue dot is1125560
Current index: 1125, 560
[0m[ INFO] [1680386262.802194478]: Start indexes DFS exploration: (1125, 560)
[0m
size of dfs stack is1 DFS exploring nodes for path 1125, 560
DFS occupied 0
DFS visited 1
exploring nearby nodes1125, 559 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1124, 560 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1124, 560
exploring nearby nodes1126, 560 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 560
exploring nearby nodes1125, 561 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 561
size of dfs stack is3 DFS exploring nodes for path 1125, 561
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1125561
slam distance in float is 0.0222311
tello distance between the two points is 7.04751
dfs_destinations.size() == 0
exploring nearby nodes1125, 560 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1124, 561 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1124, 561
exploring nearby nodes1126, 561 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 561
exploring nearby nodes1125, 562 with probabiity-0 , visited-1 , visited locally-1
size of dfs stack is4 DFS exploring nodes for path 1126, 561
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126561
slam distance in float is 0.0314389
tello distance between the two points is 9.96647
dfs_destinations.size() == 0
exploring nearby nodes1126, 560 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 560
exploring nearby nodes1125, 561 with probabiity-0 , visited-1 , visited locally-0
exploring nearby nodes1127, 561 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 561
exploring nearby nodes1126, 562 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 562
size of dfs stack is6 DFS exploring nodes for path 1126, 562
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126562
slam distance in float is 0.049709
tello distance between the two points is 15.7583
dfs_destinations.size() == 0
exploring nearby nodes1126, 561 with probabiity-0 , visited-1 , visited locally-0
exploring nearby nodes1125, 562 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1127, 562 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 562
exploring nearby nodes1126, 563 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 563
size of dfs stack is7 DFS exploring nodes for path 1126, 563
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126563
slam distance in float is 0.0702988
tello distance between the two points is 22.2855
dfs_destinations.size() == 0
exploring nearby nodes1126, 562 with probabiity-0 , visited-1 , visited locally-0
exploring nearby nodes1125, 563 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1127, 563 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 563
exploring nearby nodes1126, 564 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 564
size of dfs stack is8 DFS exploring nodes for path 1126, 564
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126564
slam distance in float is 0.0916591
tello distance between the two points is 29.057
dfs_destinations.size() == 0
exploring nearby nodes1126, 563 with probabiity-0 , visited-1 , visited locally-0
exploring nearby nodes1125, 564 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1127, 564 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 564
exploring nearby nodes1126, 565 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 565
size of dfs stack is9 DFS exploring nodes for path 1126, 565
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126565
slam distance in float is 0.113354
tello distance between the two points is 35.9344
dfs_destinations.size() == 0
exploring nearby nodes1126, 564 with probabiity-0 , visited-1 , visited locally-0
exploring nearby nodes1125, 565 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1127, 565 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 565
exploring nearby nodes1126, 566 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 566
size of dfs stack is10 DFS exploring nodes for path 1126, 566
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126566
slam distance in float is 0.135223
tello distance between the two points is 42.8671
dfs_destinations.size() == 0
exploring nearby nodes1126, 565 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 565
exploring nearby nodes1125, 566 with probabiity-0 , visited-1 , visited locally-1
exploring nearby nodes1127, 566 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 566
exploring nearby nodes1126, 567 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 567
size of dfs stack is12 DFS exploring nodes for path 1126, 567
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126567
slam distance in float is 0.157194
tello distance between the two points is 49.8322
dfs_destinations.size() == 0
exploring nearby nodes1126, 566 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 566
exploring nearby nodes1125, 567 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 567
exploring nearby nodes1127, 567 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 567
exploring nearby nodes1126, 568 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 568
size of dfs stack is15 DFS exploring nodes for path 1126, 568
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126568
slam distance in float is 0.179228
tello distance between the two points is 56.8173
dfs_destinations.size() == 0
exploring nearby nodes1126, 567 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 567
exploring nearby nodes1125, 568 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 568
exploring nearby nodes1127, 568 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 568
exploring nearby nodes1126, 569 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 569
size of dfs stack is18 DFS exploring nodes for path 1126, 569
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126569
slam distance in float is 0.201305
tello distance between the two points is 63.8161
dfs_destinations.size() == 0
exploring nearby nodes1126, 568 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 568
exploring nearby nodes1125, 569 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 569
exploring nearby nodes1127, 569 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 569
exploring nearby nodes1126, 570 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 570
size of dfs stack is21 DFS exploring nodes for path 1126, 570
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126570
slam distance in float is 0.223414
tello distance between the two points is 70.8248
dfs_destinations.size() == 0
exploring nearby nodes1126, 569 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 569
exploring nearby nodes1125, 570 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 570
exploring nearby nodes1127, 570 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 570
exploring nearby nodes1126, 571 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 571
size of dfs stack is24 DFS exploring nodes for path 1126, 571
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126571
slam distance in float is 0.245544
tello distance between the two points is 77.8402
dfs_destinations.size() == 0
exploring nearby nodes1126, 570 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 570
exploring nearby nodes1125, 571 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 571
exploring nearby nodes1127, 571 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 571
exploring nearby nodes1126, 572 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 572
size of dfs stack is27 DFS exploring nodes for path 1126, 572
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126572
slam distance in float is 0.26769
tello distance between the two points is 84.8608
Scanning coords x: 1125 to 1126 and y: 560 to 572 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 1
exploring nearby nodes1126, 571 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 571
exploring nearby nodes1125, 572 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 572
exploring nearby nodes1127, 572 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 572
exploring nearby nodes1126, 573 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 573
size of dfs stack is30 DFS exploring nodes for path 1126, 573
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126573
slam distance in float is 0.28985
tello distance between the two points is 91.8859
Scanning coords x: 1125 to 1126 and y: 560 to 573 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 2
exploring nearby nodes1126, 572 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 572
exploring nearby nodes1125, 573 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 573
exploring nearby nodes1127, 573 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 573
exploring nearby nodes1126, 574 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 574
size of dfs stack is33 DFS exploring nodes for path 1126, 574
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126574
slam distance in float is 0.31202
tello distance between the two points is 98.9138
Scanning coords x: 1125 to 1126 and y: 560 to 574 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 3
exploring nearby nodes1126, 573 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 573
exploring nearby nodes1125, 574 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 574
exploring nearby nodes1127, 574 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 574
exploring nearby nodes1126, 575 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 575
size of dfs stack is36 DFS exploring nodes for path 1126, 575
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126575
slam distance in float is 0.334197
tello distance between the two points is 105.944
Scanning coords x: 1125 to 1126 and y: 560 to 575 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 4
exploring nearby nodes1126, 574 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 574
exploring nearby nodes1125, 575 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 575
exploring nearby nodes1127, 575 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 575
exploring nearby nodes1126, 576 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 576
size of dfs stack is39 DFS exploring nodes for path 1126, 576
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126576
slam distance in float is 0.356382
tello distance between the two points is 112.977
Scanning coords x: 1125 to 1126 and y: 560 to 576 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 5
exploring nearby nodes1126, 575 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 575
exploring nearby nodes1125, 576 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 576
exploring nearby nodes1127, 576 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 576
exploring nearby nodes1126, 577 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 577
size of dfs stack is42 DFS exploring nodes for path 1126, 577
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126577
slam distance in float is 0.378571
tello distance between the two points is 120.011
Scanning coords x: 1125 to 1126 and y: 560 to 577 with xdiff: 1 and ydiff: 2
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 6
exploring nearby nodes1126, 576 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 576
exploring nearby nodes1125, 577 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 577
exploring nearby nodes1127, 577 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 577
exploring nearby nodes1126, 578 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 578
size of dfs stack is45 DFS exploring nodes for path 1126, 578
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126578
slam distance in float is 0.400765
tello distance between the two points is 127.047
Scanning coords x: 1125 to 1126 and y: 560 to 578 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 7
exploring nearby nodes1126, 577 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 577
exploring nearby nodes1125, 578 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 578
exploring nearby nodes1127, 578 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 578
exploring nearby nodes1126, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 579
size of dfs stack is48 DFS exploring nodes for path 1126, 579
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126579
slam distance in float is 0.422964
tello distance between the two points is 134.084
Scanning coords x: 1125 to 1126 and y: 560 to 579 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 8
exploring nearby nodes1126, 578 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 578
exploring nearby nodes1125, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 579
exploring nearby nodes1127, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 579
exploring nearby nodes1126, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 580
size of dfs stack is51 DFS exploring nodes for path 1126, 580
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1126580
slam distance in float is 0.445165
tello distance between the two points is 141.122
Scanning coords x: 1125 to 1126 and y: 560 to 580 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 9
exploring nearby nodes1126, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 579
exploring nearby nodes1125, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1125, 580
exploring nearby nodes1127, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 580
exploring nearby nodes1126, 581 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is53 DFS exploring nodes for path 1127, 580
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1127580
slam distance in float is 0.446827
tello distance between the two points is 141.649
Scanning coords x: 1125 to 1127 and y: 560 to 580 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 10
exploring nearby nodes1127, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 579
exploring nearby nodes1126, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1126, 580
exploring nearby nodes1128, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 580
exploring nearby nodes1127, 581 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is55 DFS exploring nodes for path 1128, 580
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128580
slam distance in float is 0.449584
tello distance between the two points is 142.523
Scanning coords x: 1125 to 1128 and y: 560 to 580 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 11
exploring nearby nodes1128, 579 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 579
exploring nearby nodes1127, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1127, 580
exploring nearby nodes1129, 580 with probabiity-1 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 580
exploring nearby nodes1128, 581 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 581
size of dfs stack is58 DFS exploring nodes for path 1128, 581
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128581
slam distance in float is 0.47158
tello distance between the two points is 149.496
Scanning coords x: 1125 to 1128 and y: 560 to 581 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 12
exploring nearby nodes1128, 580 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 580
exploring nearby nodes1127, 581 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 581 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 581
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
size of dfs stack is60 DFS exploring nodes for path 1128, 582
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128582
slam distance in float is 0.493597
tello distance between the two points is 156.476
Scanning coords x: 1125 to 1128 and y: 560 to 582 with xdiff: 1 and ydiff: 3
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 13
exploring nearby nodes1128, 581 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 581
exploring nearby nodes1127, 582 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
size of dfs stack is62 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 14
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is63 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 15
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-0
DFS adding nearby nodes 1130, 583
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is65 DFS exploring nodes for path 1130, 583
DFS occupied 7
DFS visited 0
DFS TRAVERSAL PRINTS 1130583
slam distance in float is 0.523244
tello distance between the two points is 165.874
Scanning coords x: 1125 to 1130 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: FALSE
dfs_destinations.size() == 15
exploring nearby nodes1130, 582 with probabiity-3 , visited-0 , visited locally-0
DFS adding nearby nodes 1130, 582
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1131, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1130, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is66 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 16
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is67 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 17
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is68 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 18
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is69 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 19
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is70 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 20
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is71 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 21
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is72 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 22
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is73 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 23
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is74 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 24
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is75 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 25
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is76 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 26
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is77 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 27
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is78 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 28
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is79 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 29
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is80 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 30
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is81 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 31
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is82 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 32
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is83 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 33
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is84 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 34
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is85 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 35
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is86 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 36
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is87 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 37
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is88 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 38
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is89 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 39
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is90 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 40
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is91 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 41
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582
exploring nearby nodes1127, 583 with probabiity--1 , visited-0 , visited locally-0
exploring nearby nodes1129, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 583
exploring nearby nodes1128, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is92 DFS exploring nodes for path 1129, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1129583
slam distance in float is 0.518976
tello distance between the two points is 164.521
Scanning coords x: 1125 to 1129 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 42
exploring nearby nodes1129, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1129, 582
exploring nearby nodes1128, 583 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 583
exploring nearby nodes1130, 583 with probabiity-7 , visited-0 , visited locally-1
exploring nearby nodes1129, 584 with probabiity--1 , visited-0 , visited locally-0
size of dfs stack is93 DFS exploring nodes for path 1128, 583
DFS occupied 0
DFS visited 0
DFS TRAVERSAL PRINTS 1128583
slam distance in float is 0.515632
tello distance between the two points is 163.461
Scanning coords x: 1125 to 1128 and y: 560 to 583 with xdiff: 1 and ydiff: 4
Horizontal length is 5.675694 and Vertical length is 5.675928
is obstacle succeeded: TRUE
dfs_destinations.size() == 43
exploring nearby nodes1128, 582 with probabiity-0 , visited-0 , visited locally-0
DFS adding nearby nodes 1128, 582