typescript 29 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033
  1. Script started on 2024-09-09 21:50:10+08:00 [<not executed on terminal>]
  2. [INFO] [1725889816.712933]: Goal received, starting rosbag recording...
  3. [ INFO] [1725889816.895961423]: Subscribing to /amcl_pose
  4. [ INFO] [1725889816.897460324]: Subscribing to /imu
  5. [ INFO] [1725889816.898303132]: Subscribing to /obstacle_detection
  6. [ INFO] [1725889816.899635520]: Subscribing to /odom
  7. [ INFO] [1725889816.900591638]: Subscribing to /sys_info
  8. [ INFO] [1725889816.901747264]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-1.bag'.
  9. [INFO] [1725889844.637753]: Stopping rosbag recording...
  10. [INFO] [1725889846.223473]: Goal received, starting rosbag recording...
  11. [ INFO] [1725889846.464783998]: Subscribing to /amcl_pose
  12. [ INFO] [1725889846.465875425]: Subscribing to /imu
  13. [ INFO] [1725889846.466773790]: Subscribing to /obstacle_detection
  14. [ INFO] [1725889846.467687541]: Subscribing to /odom
  15. [ INFO] [1725889846.469430463]: Subscribing to /sys_info
  16. [ INFO] [1725889846.470926560]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-2.bag'.
  17. [INFO] [1725889875.848162]: Stopping rosbag recording...
  18. [INFO] [1725889877.735867]: Goal received, starting rosbag recording...
  19. [ INFO] [1725889877.948701350]: Subscribing to /amcl_pose
  20. [ INFO] [1725889877.949976398]: Subscribing to /imu
  21. [ INFO] [1725889877.950758479]: Subscribing to /obstacle_detection
  22. [ INFO] [1725889877.951450871]: Subscribing to /odom
  23. [ INFO] [1725889877.952633582]: Subscribing to /sys_info
  24. [ INFO] [1725889877.953753078]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-3.bag'.
  25. [INFO] [1725889901.602255]: Stopping rosbag recording...
  26. [INFO] [1725889903.245801]: Goal received, starting rosbag recording...
  27. [ INFO] [1725889903.458603598]: Subscribing to /amcl_pose
  28. [ INFO] [1725889903.459616226]: Subscribing to /imu
  29. [ INFO] [1725889903.460237235]: Subscribing to /obstacle_detection
  30. [ INFO] [1725889903.460908566]: Subscribing to /odom
  31. [ INFO] [1725889903.461657705]: Subscribing to /sys_info
  32. [ INFO] [1725889903.463440327]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-4.bag'.
  33. [INFO] [1725889933.931829]: Stopping rosbag recording...
  34. [INFO] [1725889935.758399]: Goal received, starting rosbag recording...
  35. [ INFO] [1725889935.981904358]: Subscribing to /amcl_pose
  36. [ INFO] [1725889935.982833117]: Subscribing to /imu
  37. [ INFO] [1725889935.983471660]: Subscribing to /obstacle_detection
  38. [ INFO] [1725889935.984368014]: Subscribing to /odom
  39. [ INFO] [1725889935.985086535]: Subscribing to /sys_info
  40. [ INFO] [1725889935.986340498]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-5.bag'.
  41. [INFO] [1725889950.022877]: Stopping rosbag recording...
  42. [INFO] [1725889950.440401]: All recordings completed. Exiting...
  43. [INFO] [1725889952.444121]: Shutting down ROS node and killing the process.
  44. Script done on 2024-09-09 21:52:34+08:00 [COMMAND_EXIT_CODE="0"]
  45. ar.x: 0.4
  46. current.linear.y: 0
  47. Checking if goal is reached...
  48. Distance to goal: 4.75988
  49. current.linear.x: 0.4
  50. current.linear.y: 0
  51. Checking if goal is reached...
  52. Distance to goal: 4.5788
  53. current.linear.x: 0.4
  54. current.linear.y: 0
  55. Checking if goal is reached...
  56. Distance to goal: 4.4024
  57. current.linear.x: 0.4
  58. current.linear.y: 0
  59. Checking if goal is reached...
  60. Distance to goal: 4.2407
  61. current.linear.x: 0.4
  62. current.linear.y: 0
  63. Checking if goal is reached...
  64. Distance to goal: 4.2407
  65. current.linear.x: 0.4
  66. current.linear.y: 0
  67. Checking if goal is reached...
  68. Distance to goal: 4.08059
  69. current.linear.x: 0.4
  70. current.linear.y: 0
  71. Checking if goal is reached...
  72. Distance to goal: 3.92218
  73. current.linear.x: 0.4
  74. current.linear.y: 0
  75. Checking if goal is reached...
  76. Distance to goal: 3.76114
  77. current.linear.x: 0.4
  78. current.linear.y: 0
  79. Checking if goal is reached...
  80. Distance to goal: 3.60807
  81. current.linear.x: 0.4
  82. current.linear.y: 0
  83. Checking if goal is reached...
  84. Distance to goal: 3.46105
  85. current.linear.x: 0.4
  86. current.linear.y: 0
  87. Checking if goal is reached...
  88. Distance to goal: 3.31131
  89. current.linear.x: 0.4
  90. current.linear.y: 0
  91. Checking if goal is reached...
  92. Distance to goal: 3.18273
  93. current.linear.x: 0.4
  94. current.linear.y: 0
  95. Checking if goal is reached...
  96. Distance to goal: 3.18273
  97. current.linear.x: 0.4
  98. current.linear.y: 0
  99. Checking if goal is reached...
  100. Distance to goal: 3.04917
  101. current.linear.x: 0.4
  102. current.linear.y: 0
  103. Checking if goal is reached...
  104. Distance to goal: 2.92456
  105. current.linear.x: 0.4
  106. current.linear.y: 0
  107. Checking if goal is reached...
  108. Distance to goal: 2.80615
  109. current.linear.x: 0.4
  110. current.linear.y: 0
  111. Checking if goal is reached...
  112. Distance to goal: 2.68813
  113. current.linear.x: 0.3
  114. current.linear.y: 0
  115. Checking if goal is reached...
  116. Distance to goal: 2.55403
  117. current.linear.x: 0.3
  118. current.linear.y: 0
  119. Checking if goal is reached...
  120. Distance to goal: 2.55403
  121. current.linear.x: 0.3
  122. current.linear.y: 0
  123. Checking if goal is reached...
  124. Distance to goal: 2.40391
  125. current.linear.x: 0.2
  126. current.linear.y: 0.000632096
  127. Checking if goal is reached...
  128. Distance to goal: 2.40391
  129. current.linear.x: 0.177778
  130. current.linear.y: 0
  131. Checking if goal is reached...
  132. Distance to goal: 2.21486
  133. current.linear.x: 0.2
  134. current.linear.y: 0
  135. Checking if goal is reached...
  136. Distance to goal: 2.21486
  137. current.linear.x: 0.3
  138. current.linear.y: 0
  139. Checking if goal is reached...
  140. Distance to goal: 2.21486
  141. current.linear.x: 0.3
  142. current.linear.y: 0
  143. Checking if goal is reached...
  144. Distance to goal: 1.95568
  145. current.linear.x: 0.3
  146. current.linear.y: 0
  147. Checking if goal is reached...
  148. Distance to goal: 1.68641
  149. current.linear.x: 0.4
  150. current.linear.y: 0.000882432
  151. Checking if goal is reached...
  152. Distance to goal: 1.68641
  153. current.linear.x: 0.4
  154. current.linear.y: 0.000390354
  155. Checking if goal is reached...
  156. Distance to goal: 1.40199
  157. current.linear.x: 0.5
  158. current.linear.y: 0.000474213
  159. Checking if goal is reached...
  160. Distance to goal: 1.13294
  161. current.linear.x: 0.6
  162. current.linear.y: 0
  163. Checking if goal is reached...
  164. Distance to goal: 0.843869
  165. current.linear.x: 0.4
  166. current.linear.y: 0
  167. Checking if goal is reached...
  168. Distance to goal: 0.617331
  169. current.linear.x: 0.311111
  170. current.linear.y: 0
  171. Checking if goal is reached...
  172. Distance to goal: 0.617331
  173. current.linear.x: 0.233333
  174. current.linear.y: 0
  175. Checking if goal is reached...
  176. Distance to goal: 0.410296
  177. current.linear.x: 0.233333
  178. current.linear.y: 0
  179. Checking if goal is reached...
  180. Distance to goal: 0.410296
  181. current.linear.x: 0.155556
  182. current.linear.y: 0
  183. Checking if goal is reached...
  184. Distance to goal: 0.195718
  185. current.linear.x: 0.155556
  186. current.linear.y: 0
  187. Checking if goal is reached...
  188. Distance to goal: 0.195718
  189. current.linear.x: 0.0777778
  190. current.linear.y: 0.000480171
  191. Checking if goal is reached...
  192. Distance to goal: 0.195718
  193. current.linear.x: 0
  194. current.linear.y: 0
  195. [ INFO] [1725889845.222424852]: Goal 1 reached, proceeding to the next goal after 2 seconds...
  196. End Point set to X: 1.9673 Y: 2.2561
  197. Distance to goal: 9.26754
  198. current.linear.x: 0
  199. current.linear.y: 0
  200. Checking if goal is reached...
  201. Distance to goal: 9.32766
  202. current.linear.x: 0
  203. current.linear.y: 0
  204. Checking if goal is reached...
  205. Distance to goal: 9.33515
  206. current.linear.x: 0
  207. current.linear.y: 0
  208. Checking if goal is reached...
  209. Distance to goal: 9.34517
  210. current.linear.x: 0
  211. current.linear.y: 0
  212. Checking if goal is reached...
  213. Distance to goal: 9.34517
  214. current.linear.x: 0
  215. current.linear.y: 0
  216. Checking if goal is reached...
  217. Distance to goal: 9.3369
  218. current.linear.x: 0
  219. current.linear.y: 0
  220. Checking if goal is reached...
  221. Distance to goal: 9.3369
  222. current.linear.x: 0
  223. current.linear.y: 0
  224. Checking if goal is reached...
  225. Distance to goal: 9.3369
  226. current.linear.x: 0
  227. current.linear.y: 0
  228. Checking if goal is reached...
  229. Distance to goal: 9.32765
  230. current.linear.x: 0.7
  231. current.linear.y: 0
  232. Checking if goal is reached...
  233. Distance to goal: 9.32765
  234. current.linear.x: 0.7
  235. current.linear.y: 0.000208586
  236. Checking if goal is reached...
  237. Distance to goal: 9.09055
  238. current.linear.x: 0.7
  239. current.linear.y: 0.00201485
  240. Checking if goal is reached...
  241. Distance to goal: 8.96805
  242. current.linear.x: 0.7
  243. current.linear.y: 0.00192874
  244. Checking if goal is reached...
  245. Distance to goal: 8.84587
  246. current.linear.x: 0.6
  247. current.linear.y: 0
  248. Checking if goal is reached...
  249. Distance to goal: 8.71254
  250. current.linear.x: 0.5
  251. current.linear.y: 0.00176296
  252. Checking if goal is reached...
  253. Distance to goal: 8.53176
  254. current.linear.x: 0.4
  255. current.linear.y: 0
  256. Checking if goal is reached...
  257. Distance to goal: 8.29999
  258. current.linear.x: 0.3
  259. current.linear.y: 0
  260. Checking if goal is reached...
  261. Distance to goal: 8.29999
  262. current.linear.x: 0.3
  263. current.linear.y: 0
  264. Checking if goal is reached...
  265. Distance to goal: 8.06756
  266. current.linear.x: 0.3
  267. current.linear.y: 0
  268. Checking if goal is reached...
  269. Distance to goal: 8.06756
  270. current.linear.x: 0.2
  271. current.linear.y: 0
  272. Checking if goal is reached...
  273. Distance to goal: 7.84396
  274. current.linear.x: 0.2
  275. current.linear.y: 0
  276. Checking if goal is reached...
  277. Distance to goal: 7.84396
  278. current.linear.x: 0.3
  279. current.linear.y: 0
  280. Checking if goal is reached...
  281. Distance to goal: 7.62764
  282. current.linear.x: 0.3
  283. current.linear.y: 0
  284. Checking if goal is reached...
  285. Distance to goal: 7.62764
  286. current.linear.x: 0.3
  287. current.linear.y: 0
  288. Checking if goal is reached...
  289. Distance to goal: 7.42606
  290. current.linear.x: 0.4
  291. current.linear.y: 0
  292. Checking if goal is reached...
  293. Distance to goal: 7.17916
  294. current.linear.x: 0.4
  295. current.linear.y: 0
  296. Checking if goal is reached...
  297. Distance to goal: 6.97255
  298. current.linear.x: 0.5
  299. current.linear.y: 0
  300. Checking if goal is reached...
  301. Distance to goal: 6.72682
  302. current.linear.x: 0.5
  303. current.linear.y: 0
  304. Checking if goal is reached...
  305. Distance to goal: 6.48594
  306. current.linear.x: 0.5
  307. current.linear.y: 0
  308. Checking if goal is reached...
  309. Distance to goal: 6.23901
  310. current.linear.x: 0.5
  311. current.linear.y: 0
  312. Checking if goal is reached...
  313. Distance to goal: 6.23901
  314. current.linear.x: 0.5
  315. current.linear.y: 0
  316. Checking if goal is reached...
  317. Distance to goal: 5.98946
  318. current.linear.x: 0.5
  319. current.linear.y: -0.00089453
  320. Checking if goal is reached...
  321. Distance to goal: 5.74015
  322. current.linear.x: 0.5
  323. current.linear.y: 0
  324. Checking if goal is reached...
  325. Distance to goal: 5.50295
  326. current.linear.x: 0.5
  327. current.linear.y: 0
  328. Checking if goal is reached...
  329. Distance to goal: 5.26249
  330. current.linear.x: 0.5
  331. current.linear.y: 0
  332. Checking if goal is reached...
  333. Distance to goal: 5.01978
  334. current.linear.x: 0.5
  335. current.linear.y: 0
  336. Checking if goal is reached...
  337. Distance to goal: 4.77351
  338. current.linear.x: 0.5
  339. current.linear.y: 0
  340. Checking if goal is reached...
  341. Distance to goal: 4.53944
  342. current.linear.x: 0.5
  343. current.linear.y: 0
  344. Checking if goal is reached...
  345. Distance to goal: 4.32216
  346. current.linear.x: 0.4
  347. current.linear.y: 0
  348. Checking if goal is reached...
  349. Distance to goal: 4.14106
  350. current.linear.x: 0.3
  351. current.linear.y: 0
  352. Checking if goal is reached...
  353. Distance to goal: 4.14106
  354. current.linear.x: 0.3
  355. current.linear.y: 0
  356. Checking if goal is reached...
  357. Distance to goal: 3.94803
  358. current.linear.x: 0.3
  359. current.linear.y: 0
  360. Checking if goal is reached...
  361. Distance to goal: 3.75844
  362. current.linear.x: 0.3
  363. current.linear.y: 0
  364. Checking if goal is reached...
  365. Distance to goal: 3.75844
  366. current.linear.x: 0.3
  367. current.linear.y: 0
  368. Checking if goal is reached...
  369. Distance to goal: 3.56715
  370. current.linear.x: 0.3
  371. current.linear.y: 0
  372. Checking if goal is reached...
  373. Distance to goal: 3.36859
  374. current.linear.x: 0.3
  375. current.linear.y: 0
  376. Checking if goal is reached...
  377. Distance to goal: 3.36859
  378. current.linear.x: 0.4
  379. current.linear.y: 0
  380. Checking if goal is reached...
  381. Distance to goal: 3.12195
  382. current.linear.x: 0.5
  383. current.linear.y: 0
  384. Checking if goal is reached...
  385. Distance to goal: 2.88295
  386. current.linear.x: 0.7
  387. current.linear.y: 0
  388. Checking if goal is reached...
  389. Distance to goal: 2.40082
  390. current.linear.x: 0.7
  391. current.linear.y: 0
  392. Checking if goal is reached...
  393. Distance to goal: 2.15195
  394. current.linear.x: 0.7
  395. current.linear.y: 0
  396. Checking if goal is reached...
  397. Distance to goal: 1.89745
  398. current.linear.x: 0.7
  399. current.linear.y: 0
  400. Checking if goal is reached...
  401. Distance to goal: 1.38069
  402. current.linear.x: 0.622222
  403. current.linear.y: 0
  404. Checking if goal is reached...
  405. Distance to goal: 1.12935
  406. current.linear.x: 0.622222
  407. current.linear.y: 0
  408. Checking if goal is reached...
  409. Distance to goal: 0.897954
  410. current.linear.x: 0.466667
  411. current.linear.y: 0
  412. Checking if goal is reached...
  413. Distance to goal: 0.641669
  414. current.linear.x: 0.311111
  415. current.linear.y: 0
  416. Checking if goal is reached...
  417. Distance to goal: 0.641669
  418. current.linear.x: 0.233333
  419. current.linear.y: 0
  420. Checking if goal is reached...
  421. Distance to goal: 0.389736
  422. current.linear.x: 0.155556
  423. current.linear.y: 0.00176055
  424. Checking if goal is reached...
  425. Distance to goal: 0.389736
  426. current.linear.x: 0.155556
  427. current.linear.y: 0
  428. Checking if goal is reached...
  429. Distance to goal: 0.389736
  430. current.linear.x: 0.0777778
  431. current.linear.y: 0
  432. Checking if goal is reached...
  433. Distance to goal: 0.15187
  434. current.linear.x: 0.0777778
  435. current.linear.y: 0.000642228
  436. Checking if goal is reached...
  437. Distance to goal: 0.15187
  438. current.linear.x: 0.0777778
  439. current.linear.y: 0.000584937
  440. Checking if goal is reached...
  441. Distance to goal: 0.15187
  442. current.linear.x: 0
  443. current.linear.y: 0
  444. [ INFO] [1725889876.734948015]: Goal 2 reached, proceeding to the next goal after 2 seconds...
  445. End Point set to X: 9.9173 Y: 1.0561
  446. Distance to goal: 7.92312
  447. current.linear.x: 0
  448. current.linear.y: 0
  449. Checking if goal is reached...
  450. Distance to goal: 7.97194
  451. current.linear.x: 0
  452. current.linear.y: 0
  453. Checking if goal is reached...
  454. Distance to goal: 7.97194
  455. current.linear.x: 0
  456. current.linear.y: 0
  457. Checking if goal is reached...
  458. Distance to goal: 7.97287
  459. current.linear.x: 0
  460. current.linear.y: 0
  461. Checking if goal is reached...
  462. Distance to goal: 7.97287
  463. current.linear.x: 0
  464. current.linear.y: 0
  465. Checking if goal is reached...
  466. Distance to goal: 7.97287
  467. current.linear.x: 0
  468. current.linear.y: 0
  469. Checking if goal is reached...
  470. Distance to goal: 7.96528
  471. current.linear.x: 0
  472. current.linear.y: 0
  473. Checking if goal is reached...
  474. Distance to goal: 7.96528
  475. current.linear.x: 0.7
  476. current.linear.y: 0
  477. Checking if goal is reached...
  478. Distance to goal: 7.74181
  479. current.linear.x: 0.7
  480. current.linear.y: 0
  481. Checking if goal is reached...
  482. Distance to goal: 7.33392
  483. current.linear.x: 0.7
  484. current.linear.y: 0
  485. Checking if goal is reached...
  486. Distance to goal: 7.13553
  487. current.linear.x: 0.7
  488. current.linear.y: 0
  489. Checking if goal is reached...
  490. Distance to goal: 6.93491
  491. current.linear.x: 0.7
  492. current.linear.y: 0
  493. Checking if goal is reached...
  494. Distance to goal: 6.57102
  495. current.linear.x: 0.7
  496. current.linear.y: 0
  497. Checking if goal is reached...
  498. Distance to goal: 6.395
  499. current.linear.x: 0.7
  500. current.linear.y: 0
  501. Checking if goal is reached...
  502. Distance to goal: 6.22668
  503. current.linear.x: 0.7
  504. current.linear.y: 0
  505. Checking if goal is reached...
  506. Distance to goal: 5.91362
  507. current.linear.x: 0.5
  508. current.linear.y: 0
  509. Checking if goal is reached...
  510. Distance to goal: 5.72438
  511. current.linear.x: 0.4
  512. current.linear.y: 0
  513. Checking if goal is reached...
  514. Distance to goal: 5.72438
  515. current.linear.x: 0.3
  516. current.linear.y: 0
  517. Checking if goal is reached...
  518. Distance to goal: 5.54534
  519. current.linear.x: 0.3
  520. current.linear.y: 0
  521. Checking if goal is reached...
  522. Distance to goal: 5.39549
  523. current.linear.x: 0.3
  524. current.linear.y: 0
  525. Checking if goal is reached...
  526. Distance to goal: 5.39549
  527. current.linear.x: 0.3
  528. current.linear.y: 0
  529. Checking if goal is reached...
  530. Distance to goal: 5.23857
  531. current.linear.x: 0.3
  532. current.linear.y: 0
  533. Checking if goal is reached...
  534. Distance to goal: 5.07373
  535. current.linear.x: 0.3
  536. current.linear.y: 0
  537. Checking if goal is reached...
  538. Distance to goal: 5.07373
  539. current.linear.x: 0.3
  540. current.linear.y: 0
  541. Checking if goal is reached...
  542. Distance to goal: 4.89839
  543. current.linear.x: 0.4
  544. current.linear.y: 0
  545. Checking if goal is reached...
  546. Distance to goal: 4.68062
  547. current.linear.x: 0.4
  548. current.linear.y: 0
  549. Checking if goal is reached...
  550. Distance to goal: 4.46756
  551. current.linear.x: 0.5
  552. current.linear.y: 0
  553. Checking if goal is reached...
  554. Distance to goal: 4.21821
  555. current.linear.x: 0.5
  556. current.linear.y: 0
  557. Checking if goal is reached...
  558. Distance to goal: 4.21821
  559. current.linear.x: 0.5
  560. current.linear.y: 0
  561. Checking if goal is reached...
  562. Distance to goal: 3.97204
  563. current.linear.x: 0.5
  564. current.linear.y: 0
  565. Checking if goal is reached...
  566. Distance to goal: 3.73201
  567. current.linear.x: 0.6
  568. current.linear.y: 0
  569. Checking if goal is reached...
  570. Distance to goal: 3.44047
  571. current.linear.x: 0.7
  572. current.linear.y: 0
  573. Checking if goal is reached...
  574. Distance to goal: 2.96972
  575. current.linear.x: 0.6
  576. current.linear.y: 0
  577. Checking if goal is reached...
  578. Distance to goal: 2.75217
  579. current.linear.x: 0.5
  580. current.linear.y: 0
  581. Checking if goal is reached...
  582. Distance to goal: 2.48457
  583. current.linear.x: 0.5
  584. current.linear.y: 0
  585. Checking if goal is reached...
  586. Distance to goal: 2.25528
  587. current.linear.x: 0.4
  588. current.linear.y: 0
  589. Checking if goal is reached...
  590. Distance to goal: 2.25528
  591. current.linear.x: 0.4
  592. current.linear.y: 0
  593. Checking if goal is reached...
  594. Distance to goal: 1.98716
  595. current.linear.x: 0.4
  596. current.linear.y: 0.00146603
  597. Checking if goal is reached...
  598. Distance to goal: 1.70888
  599. current.linear.x: 0.4
  600. current.linear.y: 7.58757e-05
  601. Checking if goal is reached...
  602. Distance to goal: 1.70888
  603. current.linear.x: 0.5
  604. current.linear.y: 0
  605. Checking if goal is reached...
  606. Distance to goal: 1.39255
  607. current.linear.x: 0.6
  608. current.linear.y: 0
  609. Checking if goal is reached...
  610. Distance to goal: 1.10641
  611. current.linear.x: 0.544444
  612. current.linear.y: 0
  613. Checking if goal is reached...
  614. Distance to goal: 0.783638
  615. current.linear.x: 0.388889
  616. current.linear.y: 0
  617. Checking if goal is reached...
  618. Distance to goal: 0.530275
  619. current.linear.x: 0.311111
  620. current.linear.y: 0
  621. Checking if goal is reached...
  622. Distance to goal: 0.530275
  623. current.linear.x: 0.233333
  624. current.linear.y: 0
  625. Checking if goal is reached...
  626. Distance to goal: 0.530275
  627. current.linear.x: 0.155556
  628. current.linear.y: 0
  629. Checking if goal is reached...
  630. Distance to goal: 0.278343
  631. current.linear.x: 0.155556
  632. current.linear.y: 8.32494e-05
  633. Checking if goal is reached...
  634. Distance to goal: 0.278343
  635. current.linear.x: 0.0777778
  636. current.linear.y: 0.000395192
  637. Checking if goal is reached...
  638. Distance to goal: 0.278343
  639. current.linear.x: 0.0777778
  640. current.linear.y: 0.000500804
  641. Checking if goal is reached...
  642. Distance to goal: 0.278343
  643. current.linear.x: 0
  644. current.linear.y: 0
  645. [ INFO] [1725889902.244738003]: Goal 3 reached, proceeding to the next goal after 2 seconds...
  646. End Point set to X: 5.4673 Y: 9.8061
  647. Distance to goal: 9.53891
  648. current.linear.x: 0
  649. current.linear.y: 0
  650. Checking if goal is reached...
  651. Distance to goal: 9.74089
  652. current.linear.x: 0
  653. current.linear.y: 0
  654. Checking if goal is reached...
  655. Distance to goal: 9.74089
  656. current.linear.x: 0
  657. current.linear.y: 0
  658. Checking if goal is reached...
  659. Distance to goal: 9.74939
  660. current.linear.x: 0
  661. current.linear.y: 0
  662. Checking if goal is reached...
  663. Distance to goal: 9.7516
  664. current.linear.x: 0
  665. current.linear.y: 0
  666. Checking if goal is reached...
  667. Distance to goal: 9.7535
  668. current.linear.x: 0
  669. current.linear.y: 0
  670. Checking if goal is reached...
  671. Distance to goal: 9.7535
  672. current.linear.x: 0
  673. current.linear.y: 0
  674. Checking if goal is reached...
  675. Distance to goal: 9.76427
  676. current.linear.x: 0
  677. current.linear.y: 0
  678. Checking if goal is reached...
  679. Distance to goal: 9.76427
  680. current.linear.x: 0
  681. current.linear.y: 0
  682. Checking if goal is reached...
  683. Distance to goal: 9.76427
  684. current.linear.x: 0.7
  685. current.linear.y: 0
  686. Checking if goal is reached...
  687. Distance to goal: 9.43537
  688. current.linear.x: 0.7
  689. current.linear.y: 0.000781778
  690. Checking if goal is reached...
  691. Distance to goal: 9.18567
  692. current.linear.x: 0.7
  693. current.linear.y: 0
  694. Checking if goal is reached...
  695. Distance to goal: 8.93084
  696. current.linear.x: 0.7
  697. current.linear.y: 0.000702222
  698. Checking if goal is reached...
  699. Distance to goal: 8.67503
  700. current.linear.x: 0.5
  701. current.linear.y: 0.000282957
  702. Checking if goal is reached...
  703. Distance to goal: 8.35396
  704. current.linear.x: 0.4
  705. current.linear.y: 0
  706. Checking if goal is reached...
  707. Distance to goal: 8.06723
  708. current.linear.x: 0.3
  709. current.linear.y: 0
  710. Checking if goal is reached...
  711. Distance to goal: 8.06723
  712. current.linear.x: 0.3
  713. current.linear.y: 0.000339709
  714. Checking if goal is reached...
  715. Distance to goal: 7.79396
  716. current.linear.x: 0.3
  717. current.linear.y: 0
  718. Checking if goal is reached...
  719. Distance to goal: 7.79396
  720. current.linear.x: 0.4
  721. current.linear.y: 0.000946524
  722. Checking if goal is reached...
  723. Distance to goal: 7.55526
  724. current.linear.x: 0.4
  725. current.linear.y: 0
  726. Checking if goal is reached...
  727. Distance to goal: 7.55526
  728. current.linear.x: 0.4
  729. current.linear.y: 0.00157058
  730. Checking if goal is reached...
  731. Distance to goal: 7.33968
  732. current.linear.x: 0.5
  733. current.linear.y: 0.000156814
  734. Checking if goal is reached...
  735. Distance to goal: 7.16049
  736. current.linear.x: 0.5
  737. current.linear.y: 0
  738. Checking if goal is reached...
  739. Distance to goal: 6.98157
  740. current.linear.x: 0.6
  741. current.linear.y: 0
  742. Checking if goal is reached...
  743. Distance to goal: 6.67728
  744. current.linear.x: 0.7
  745. current.linear.y: 0
  746. Checking if goal is reached...
  747. Distance to goal: 6.52804
  748. current.linear.x: 0.6
  749. current.linear.y: 0
  750. Checking if goal is reached...
  751. Distance to goal: 6.40035
  752. current.linear.x: 0.5
  753. current.linear.y: 0
  754. Checking if goal is reached...
  755. Distance to goal: 6.29119
  756. current.linear.x: 0.5
  757. current.linear.y: 0.000227608
  758. Checking if goal is reached...
  759. Distance to goal: 6.15883
  760. current.linear.x: 0.5
  761. current.linear.y: 0
  762. Checking if goal is reached...
  763. Distance to goal: 6.04021
  764. current.linear.x: 0.4
  765. current.linear.y: 0.000826833
  766. Checking if goal is reached...
  767. Distance to goal: 5.94878
  768. current.linear.x: 0.4
  769. current.linear.y: 0
  770. Checking if goal is reached...
  771. Distance to goal: 5.82632
  772. current.linear.x: 0.266667
  773. current.linear.y: 0
  774. Checking if goal is reached...
  775. Distance to goal: 5.82632
  776. current.linear.x: 0.3
  777. current.linear.y: 0
  778. Checking if goal is reached...
  779. Distance to goal: 5.6671
  780. current.linear.x: 0.3
  781. current.linear.y: 0
  782. Checking if goal is reached...
  783. Distance to goal: 5.6671
  784. current.linear.x: 0.2
  785. current.linear.y: 0
  786. Checking if goal is reached...
  787. Distance to goal: 5.6671
  788. current.linear.x: 0.2
  789. current.linear.y: 0
  790. Checking if goal is reached...
  791. Distance to goal: 5.4452
  792. current.linear.x: 0.2
  793. current.linear.y: 0
  794. Checking if goal is reached...
  795. Distance to goal: 5.4452
  796. current.linear.x: 0.3
  797. current.linear.y: 0
  798. Checking if goal is reached...
  799. Distance to goal: 5.21297
  800. current.linear.x: 0.3
  801. current.linear.y: 0
  802. Checking if goal is reached...
  803. Distance to goal: 5.21297
  804. current.linear.x: 0.3
  805. current.linear.y: 0
  806. Checking if goal is reached...
  807. Distance to goal: 4.96571
  808. current.linear.x: 0.4
  809. current.linear.y: 0
  810. Checking if goal is reached...
  811. Distance to goal: 4.96571
  812. current.linear.x: 0.4
  813. current.linear.y: 0
  814. Checking if goal is reached...
  815. Distance to goal: 4.70576
  816. current.linear.x: 0.5
  817. current.linear.y: 0
  818. Checking if goal is reached...
  819. Distance to goal: 4.47331
  820. current.linear.x: 0.5
  821. current.linear.y: 0
  822. Checking if goal is reached...
  823. Distance to goal: 4.21715
  824. current.linear.x: 0.5
  825. current.linear.y: 0
  826. Checking if goal is reached...
  827. Distance to goal: 3.94036
  828. current.linear.x: 0.5
  829. current.linear.y: 0
  830. Checking if goal is reached...
  831. Distance to goal: 3.66977
  832. current.linear.x: 0.6
  833. current.linear.y: 0
  834. Checking if goal is reached...
  835. Distance to goal: 3.44836
  836. current.linear.x: 0.6
  837. current.linear.y: 0
  838. Checking if goal is reached...
  839. Distance to goal: 3.0241
  840. current.linear.x: 0.6
  841. current.linear.y: 0
  842. Checking if goal is reached...
  843. Distance to goal: 2.82221
  844. current.linear.x: 0.7
  845. current.linear.y: 0
  846. Checking if goal is reached...
  847. Distance to goal: 2.59367
  848. current.linear.x: 0.7
  849. current.linear.y: 0
  850. Checking if goal is reached...
  851. Distance to goal: 2.11614
  852. current.linear.x: 0.7
  853. current.linear.y: 0
  854. Checking if goal is reached...
  855. Distance to goal: 1.8659
  856. current.linear.x: 0.6
  857. current.linear.y: 0
  858. Checking if goal is reached...
  859. Distance to goal: 1.63827
  860. current.linear.x: 0.6
  861. current.linear.y: 0
  862. Checking if goal is reached...
  863. Distance to goal: 1.16935
  864. current.linear.x: 0.6
  865. current.linear.y: 0
  866. Checking if goal is reached...
  867. Distance to goal: 0.960328
  868. current.linear.x: 0.466667
  869. current.linear.y: 0
  870. Checking if goal is reached...
  871. Distance to goal: 0.70775
  872. current.linear.x: 0.4
  873. current.linear.y: 0.000144815
  874. Checking if goal is reached...
  875. Distance to goal: 0.70775
  876. current.linear.x: 0.311111
  877. current.linear.y: 0
  878. Checking if goal is reached...
  879. Distance to goal: 0.466187
  880. current.linear.x: 0.233333
  881. current.linear.y: 0
  882. Checking if goal is reached...
  883. Distance to goal: 0.267102
  884. current.linear.x: 0.155556
  885. current.linear.y: 0
  886. Checking if goal is reached...
  887. Distance to goal: 0.267102
  888. current.linear.x: 0.155556
  889. current.linear.y: 0
  890. Checking if goal is reached...
  891. Distance to goal: 0.267102
  892. current.linear.x: 0.0777778
  893. current.linear.y: 0
  894. Checking if goal is reached...
  895. Distance to goal: 0.267102
  896. current.linear.x: 0.0777778
  897. current.linear.y: 0
  898. Checking if goal is reached...
  899. Distance to goal: 0.267102
  900. current.linear.x: 0
  901. current.linear.y: 0
  902. [ INFO] [1725889934.757422115]: Goal 4 reached, proceeding to the next goal after 2 seconds...
  903. End Point set to X: 3.5673 Y: 4.9061
  904. Distance to goal: 4.99152
  905. current.linear.x: 0
  906. current.linear.y: 0
  907. Checking if goal is reached...
  908. Distance to goal: 5.17076
  909. current.linear.x: 0
  910. current.linear.y: 0
  911. Checking if goal is reached...
  912. Distance to goal: 5.17076
  913. current.linear.x: 0
  914. current.linear.y: 0
  915. Checking if goal is reached...
  916. Distance to goal: 5.17239
  917. current.linear.x: 0
  918. current.linear.y: 0
  919. Checking if goal is reached...
  920. Distance to goal: 5.17294
  921. current.linear.x: 0
  922. current.linear.y: 0
  923. Checking if goal is reached...
  924. Distance to goal: 5.17294
  925. current.linear.x: 0
  926. current.linear.y: 0
  927. Checking if goal is reached...
  928. Distance to goal: 5.17994
  929. current.linear.x: 0
  930. current.linear.y: 0
  931. Checking if goal is reached...
  932. Distance to goal: 5.17994
  933. current.linear.x: 0
  934. current.linear.y: 0
  935. Checking if goal is reached...
  936. Distance to goal: 5.17994
  937. current.linear.x: 0
  938. current.linear.y: 0
  939. Checking if goal is reached...
  940. Distance to goal: 5.17994
  941. current.linear.x: 0.7
  942. current.linear.y: 0
  943. Checking if goal is reached...
  944. Distance to goal: 4.90516
  945. current.linear.x: 0.7
  946. current.linear.y: 0
  947. Checking if goal is reached...
  948. Distance to goal: 4.43814
  949. current.linear.x: 0.7
  950. current.linear.y: 0
  951. Checking if goal is reached...
  952. Distance to goal: 4.17975
  953. current.linear.x: 0.7
  954. current.linear.y: 0
  955. Checking if goal is reached...
  956. Distance to goal: 3.91375
  957. current.linear.x: 0.7
  958. current.linear.y: 0
  959. Checking if goal is reached...
  960. Distance to goal: 3.42043
  961. current.linear.x: 0.7
  962. current.linear.y: 0
  963. Checking if goal is reached...
  964. Distance to goal: 3.17727
  965. current.linear.x: 0.7
  966. current.linear.y: 0
  967. Checking if goal is reached...
  968. Distance to goal: 2.93366
  969. current.linear.x: 0.7
  970. current.linear.y: 0
  971. Checking if goal is reached...
  972. Distance to goal: 2.4329
  973. current.linear.x: 0.7
  974. current.linear.y: 0
  975. Checking if goal is reached...
  976. Distance to goal: 2.18673
  977. current.linear.x: 0.7
  978. current.linear.y: 0
  979. Checking if goal is reached...
  980. Distance to goal: 1.68065
  981. current.linear.x: 0.7
  982. current.linear.y: 0
  983. Checking if goal is reached...
  984. Distance to goal: 1.44074
  985. current.linear.x: 0.7
  986. current.linear.y: 0
  987. Checking if goal is reached...
  988. Distance to goal: 1.18365
  989. current.linear.x: 0.622222
  990. current.linear.y: 0
  991. Checking if goal is reached...
  992. Distance to goal: 0.953774
  993. current.linear.x: 0.388889
  994. current.linear.y: 0
  995. Checking if goal is reached...
  996. Distance to goal: 0.692977
  997. current.linear.x: 0.311111
  998. current.linear.y: 0
  999. Checking if goal is reached...
  1000. Distance to goal: 0.455413
  1001. current.linear.x: 0.233333
  1002. current.linear.y: 0
  1003. Checking if goal is reached...
  1004. Distance to goal: 0.455413
  1005. current.linear.x: 0.155556
  1006. current.linear.y: 0
  1007. Checking if goal is reached...
  1008. Distance to goal: 0.455413
  1009. current.linear.x: 0.155556
  1010. current.linear.y: 0
  1011. Checking if goal is reached...
  1012. Distance to goal: 0.220117
  1013. current.linear.x: 0.155556
  1014. current.linear.y: 0
  1015. Checking if goal is reached...
  1016. Distance to goal: 0.220117
  1017. current.linear.x: 0.0777778
  1018. current.linear.y: 0
  1019. Checking if goal is reached...
  1020. Distance to goal: 0.220117
  1021. current.linear.x: 0.0777778
  1022. current.linear.y: 0
  1023. Checking if goal is reached...
  1024. Distance to goal: 0.220117
  1025. current.linear.x: 0
  1026. current.linear.y: 0
  1027. [ INFO] [1725889950.764216408]: Goal 5 reached, proceeding to the next goal after 2 seconds...
  1028. [ INFO] [1725889951.764373157]: All goals reached, exiting program.
  1029. [ WARN] [1725890188.820806651]: Shutdown request received.
  1030. [ WARN] [1725890188.820860785]: Reason given for shutdown: [user request]
  1031. Script done on 2024-09-09 21:56:28+08:00 [COMMAND_EXIT_CODE="0"]