typescript 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571
  1. Script started on 2024-10-11 11:16:15+08:00 [<not executed on terminal>]
  2. [INFO] [1728616581.024300, 39.385000]: Goal received, starting rosbag recording...
  3. [ INFO] [1728616581.216027626]: Subscribing to /amcl_pose
  4. [ INFO] [1728616581.217067452]: Subscribing to /imu
  5. [ INFO] [1728616581.218209602]: Subscribing to /obstacle_detection
  6. [ INFO] [1728616581.218993581]: Subscribing to /odom
  7. [ INFO] [1728616581.220243837]: Subscribing to /sys_info
  8. [ INFO] [1728616581.221516481]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-1.bag'.
  9. [INFO] [1728616610.172074, 66.285000]: Stopping rosbag recording...
  10. [INFO] [1728616611.975764, 67.893000]: Goal received, starting rosbag recording...
  11. [ INFO] [1728616612.178647017]: Subscribing to /amcl_pose
  12. [ INFO] [1728616612.180807530]: Subscribing to /imu
  13. [ INFO] [1728616612.182218238]: Subscribing to /obstacle_detection
  14. [ INFO] [1728616612.184152883]: Subscribing to /odom
  15. [ INFO] [1728616612.185843282]: Subscribing to /sys_info
  16. [ INFO] [1728616612.186892322]: Recording to '/home/cicv/work/pji_desktop/simulation/data/record_bag/test-2.bag'.
  17. [INFO] [1728616637.283010, 90.592000]: Stopping rosbag recording...
  18. [INFO] [1728616637.417460, 90.685000]: Stopping rosbag recording...
  19. [INFO] [1728616637.582412, 90.827000]: All recordings completed. Exiting...
  20. [INFO] [1728616639.314068, 92.401000]: Recording limit reached. Exiting...
  21. [INFO] [1728616639.316357, 92.402000]: Shutting down ROS node and killing the process.
  22. [INFO] [1728616639.796093, 92.828000]: Shutting down ROS node and killing the process.
  23. Script done on 2024-10-11 11:17:21+08:00 [COMMAND_EXIT_CODE="0"]
  24. urrent.linear.x: 0
  25. current.linear.y: 0
  26. Checking if goal is reached...
  27. Distance to goal: 5.89975
  28. current.linear.x: 0
  29. current.linear.y: 0
  30. Checking if goal is reached...
  31. Distance to goal: 5.89975
  32. current.linear.x: 0
  33. current.linear.y: 0
  34. Checking if goal is reached...
  35. Distance to goal: 5.89975
  36. current.linear.x: 0.5
  37. current.linear.y: -0.00124739
  38. Checking if goal is reached...
  39. Distance to goal: 5.74122
  40. current.linear.x: 0.4
  41. current.linear.y: 0
  42. Checking if goal is reached...
  43. Distance to goal: 5.74122
  44. current.linear.x: 0.3
  45. current.linear.y: 6.02594e-05
  46. Checking if goal is reached...
  47. Distance to goal: 5.55078
  48. current.linear.x: 0.3
  49. current.linear.y: 0
  50. Checking if goal is reached...
  51. Distance to goal: 5.55078
  52. current.linear.x: 0.3
  53. current.linear.y: 0.000142122
  54. Checking if goal is reached...
  55. Distance to goal: 5.32603
  56. current.linear.x: 0.3
  57. current.linear.y: 0.000170943
  58. Checking if goal is reached...
  59. Distance to goal: 5.32603
  60. current.linear.x: 0.3
  61. current.linear.y: 0.000240446
  62. Checking if goal is reached...
  63. Distance to goal: 5.10807
  64. current.linear.x: 0.4
  65. current.linear.y: 0.00174979
  66. Checking if goal is reached...
  67. Distance to goal: 4.89888
  68. current.linear.x: 0.4
  69. current.linear.y: 0.000629316
  70. Checking if goal is reached...
  71. Distance to goal: 4.69718
  72. current.linear.x: 0.5
  73. current.linear.y: 0
  74. Checking if goal is reached...
  75. Distance to goal: 4.41036
  76. current.linear.x: 0.7
  77. current.linear.y: 0
  78. Checking if goal is reached...
  79. Distance to goal: 4.15644
  80. current.linear.x: 0.5
  81. current.linear.y: -0.00103255
  82. Checking if goal is reached...
  83. Distance to goal: 3.91931
  84. current.linear.x: 0.4
  85. current.linear.y: 0
  86. Checking if goal is reached...
  87. Distance to goal: 3.70009
  88. current.linear.x: 0.5
  89. current.linear.y: 0
  90. Checking if goal is reached...
  91. Distance to goal: 3.45375
  92. current.linear.x: 0.444444
  93. current.linear.y: 0
  94. Checking if goal is reached...
  95. Distance to goal: 3.21538
  96. current.linear.x: 0.444444
  97. current.linear.y: 0
  98. Checking if goal is reached...
  99. Distance to goal: 2.95304
  100. current.linear.x: 0.5
  101. current.linear.y: 0
  102. Checking if goal is reached...
  103. Distance to goal: 2.95304
  104. current.linear.x: 0.4
  105. current.linear.y: 0
  106. Checking if goal is reached...
  107. Distance to goal: 2.73925
  108. current.linear.x: 0.3
  109. current.linear.y: 0.000165471
  110. Checking if goal is reached...
  111. Distance to goal: 2.51282
  112. current.linear.x: 0.2
  113. current.linear.y: 0
  114. Checking if goal is reached...
  115. Distance to goal: 2.51282
  116. current.linear.x: 0.2
  117. current.linear.y: 0.000188372
  118. Checking if goal is reached...
  119. Distance to goal: 2.51282
  120. current.linear.x: 0.2
  121. current.linear.y: 7.04614e-05
  122. Checking if goal is reached...
  123. Distance to goal: 2.27595
  124. current.linear.x: 0.2
  125. current.linear.y: 0
  126. Checking if goal is reached...
  127. Distance to goal: 2.27595
  128. current.linear.x: 0.2
  129. current.linear.y: 0.00091407
  130. Checking if goal is reached...
  131. Distance to goal: 2.05103
  132. current.linear.x: 0.2
  133. current.linear.y: 0
  134. Checking if goal is reached...
  135. Distance to goal: 2.05103
  136. current.linear.x: 0.2
  137. current.linear.y: 0
  138. Checking if goal is reached...
  139. Distance to goal: 1.84199
  140. current.linear.x: 0.177778
  141. current.linear.y: 0.000249047
  142. Checking if goal is reached...
  143. Distance to goal: 1.84199
  144. current.linear.x: 0.2
  145. current.linear.y: 0.000267907
  146. Checking if goal is reached...
  147. Distance to goal: 1.63738
  148. current.linear.x: 0.233333
  149. current.linear.y: 0.000129806
  150. Checking if goal is reached...
  151. Distance to goal: 1.63738
  152. current.linear.x: 0.2
  153. current.linear.y: 0
  154. Checking if goal is reached...
  155. Distance to goal: 1.63738
  156. current.linear.x: 0.133333
  157. current.linear.y: 0
  158. Checking if goal is reached...
  159. Distance to goal: 1.43501
  160. current.linear.x: 0.177778
  161. current.linear.y: 0
  162. Checking if goal is reached...
  163. Distance to goal: 1.43501
  164. current.linear.x: 0.2
  165. current.linear.y: 0
  166. Checking if goal is reached...
  167. Distance to goal: 1.43501
  168. current.linear.x: 0.2
  169. current.linear.y: 0
  170. Checking if goal is reached...
  171. Distance to goal: 1.26372
  172. current.linear.x: 0.2
  173. current.linear.y: 0
  174. Checking if goal is reached...
  175. Distance to goal: 1.26372
  176. current.linear.x: 0.2
  177. current.linear.y: 0.000256419
  178. Checking if goal is reached...
  179. Distance to goal: 1.10692
  180. current.linear.x: 0.2
  181. current.linear.y: 0.00174867
  182. Checking if goal is reached...
  183. Distance to goal: 1.10692
  184. current.linear.x: 0.2
  185. current.linear.y: 0
  186. Checking if goal is reached...
  187. Distance to goal: 0.952484
  188. current.linear.x: 0.177778
  189. current.linear.y: 0
  190. Checking if goal is reached...
  191. Distance to goal: 0.952484
  192. current.linear.x: 0.2
  193. current.linear.y: 0
  194. Checking if goal is reached...
  195. Distance to goal: 0.952484
  196. current.linear.x: 0.2
  197. current.linear.y: 0.00109587
  198. Checking if goal is reached...
  199. Distance to goal: 0.751948
  200. current.linear.x: 0.2
  201. current.linear.y: 0
  202. Checking if goal is reached...
  203. Distance to goal: 0.751948
  204. current.linear.x: 0.2
  205. current.linear.y: 0
  206. Checking if goal is reached...
  207. Distance to goal: 0.491513
  208. current.linear.x: 0.266667
  209. current.linear.y: 0
  210. Checking if goal is reached...
  211. Distance to goal: 0.491513
  212. current.linear.x: 0.2
  213. current.linear.y: 0
  214. Checking if goal is reached...
  215. Distance to goal: 0.491513
  216. current.linear.x: 0.166667
  217. current.linear.y: 0.00138019
  218. Checking if goal is reached...
  219. Distance to goal: 0.224612
  220. current.linear.x: 0.133333
  221. current.linear.y: 0.000446061
  222. Checking if goal is reached...
  223. Distance to goal: 0.224612
  224. current.linear.x: 0.1
  225. current.linear.y: 0.00181511
  226. Checking if goal is reached...
  227. Distance to goal: 0.224612
  228. current.linear.x: 0
  229. current.linear.y: 0
  230. [ INFO] [1728616610.859334173, 66.893000000]: Goal 1 reached, proceeding to the next goal after 2 seconds...
  231. End Point set to X: -8.2228 Y: 0.3353
  232. Distance to goal: 5.75793
  233. current.linear.x: 0
  234. current.linear.y: 0
  235. Checking if goal is reached...
  236. Distance to goal: 5.83065
  237. current.linear.x: 0
  238. current.linear.y: 0
  239. Checking if goal is reached...
  240. Distance to goal: 5.83101
  241. current.linear.x: 0
  242. current.linear.y: 0
  243. Checking if goal is reached...
  244. Distance to goal: 5.83101
  245. current.linear.x: 0
  246. current.linear.y: 0
  247. Checking if goal is reached...
  248. Distance to goal: 5.82787
  249. current.linear.x: 0
  250. current.linear.y: 0
  251. Checking if goal is reached...
  252. Distance to goal: 5.82364
  253. current.linear.x: 0
  254. current.linear.y: 0
  255. Checking if goal is reached...
  256. Distance to goal: 5.82364
  257. current.linear.x: 0
  258. current.linear.y: 0
  259. Checking if goal is reached...
  260. Distance to goal: 5.82926
  261. current.linear.x: 0
  262. current.linear.y: 0
  263. Checking if goal is reached...
  264. Distance to goal: 5.82926
  265. current.linear.x: 0.3
  266. current.linear.y: 0
  267. Checking if goal is reached...
  268. Distance to goal: 5.82926
  269. current.linear.x: 0.3
  270. current.linear.y: 0
  271. Checking if goal is reached...
  272. Distance to goal: 5.75513
  273. current.linear.x: 0.3
  274. current.linear.y: 0
  275. Checking if goal is reached...
  276. Distance to goal: 5.75513
  277. current.linear.x: 0.266667
  278. current.linear.y: 0
  279. Checking if goal is reached...
  280. Distance to goal: 5.6322
  281. current.linear.x: 0.3
  282. current.linear.y: 0
  283. Checking if goal is reached...
  284. Distance to goal: 5.6322
  285. current.linear.x: 0.3
  286. current.linear.y: 0
  287. Checking if goal is reached...
  288. Distance to goal: 5.42462
  289. current.linear.x: 0.3
  290. current.linear.y: 0
  291. Checking if goal is reached...
  292. Distance to goal: 5.42462
  293. current.linear.x: 0.3
  294. current.linear.y: 0
  295. Checking if goal is reached...
  296. Distance to goal: 5.20623
  297. current.linear.x: 0.3
  298. current.linear.y: 0
  299. Checking if goal is reached...
  300. Distance to goal: 4.98486
  301. current.linear.x: 0.4
  302. current.linear.y: 0
  303. Checking if goal is reached...
  304. Distance to goal: 4.78848
  305. current.linear.x: 0.4
  306. current.linear.y: 0
  307. Checking if goal is reached...
  308. Distance to goal: 4.78848
  309. current.linear.x: 0.5
  310. current.linear.y: -0.00101535
  311. Checking if goal is reached...
  312. Distance to goal: 4.57387
  313. current.linear.x: 0.7
  314. current.linear.y: 0
  315. Checking if goal is reached...
  316. Distance to goal: 4.02386
  317. current.linear.x: 0.5
  318. current.linear.y: 0
  319. Checking if goal is reached...
  320. Distance to goal: 3.74852
  321. current.linear.x: 0.4
  322. current.linear.y: 0
  323. Checking if goal is reached...
  324. Distance to goal: 3.74852
  325. current.linear.x: 0.4
  326. current.linear.y: 0
  327. Checking if goal is reached...
  328. Distance to goal: 3.54375
  329. current.linear.x: 0.4
  330. current.linear.y: 0
  331. Checking if goal is reached...
  332. Distance to goal: 3.34906
  333. current.linear.x: 0.4
  334. current.linear.y: 0
  335. Checking if goal is reached...
  336. Distance to goal: 3.14366
  337. current.linear.x: 0.5
  338. current.linear.y: 0
  339. Checking if goal is reached...
  340. Distance to goal: 2.88886
  341. current.linear.x: 0.5
  342. current.linear.y: 0
  343. Checking if goal is reached...
  344. Distance to goal: 2.61388
  345. current.linear.x: 0.4
  346. current.linear.y: 0
  347. Checking if goal is reached...
  348. Distance to goal: 2.40833
  349. current.linear.x: 0.4
  350. current.linear.y: 0
  351. Checking if goal is reached...
  352. Distance to goal: 2.21847
  353. current.linear.x: 0.4
  354. current.linear.y: 0
  355. Checking if goal is reached...
  356. Distance to goal: 2.02557
  357. current.linear.x: 0.5
  358. current.linear.y: 0
  359. Checking if goal is reached...
  360. Distance to goal: 1.79434
  361. current.linear.x: 0.7
  362. current.linear.y: 0
  363. Checking if goal is reached...
  364. Distance to goal: 1.5912
  365. current.linear.x: 0.5
  366. current.linear.y: -0.000908178
  367. Checking if goal is reached...
  368. Distance to goal: 1.32263
  369. current.linear.x: 0.4
  370. current.linear.y: 0
  371. Checking if goal is reached...
  372. Distance to goal: 1.32263
  373. current.linear.x: 0.3
  374. current.linear.y: 0
  375. Checking if goal is reached...
  376. Distance to goal: 1.07991
  377. current.linear.x: 0.3
  378. current.linear.y: 0
  379. Checking if goal is reached...
  380. Distance to goal: 0.850306
  381. current.linear.x: 0.2
  382. current.linear.y: 0
  383. Checking if goal is reached...
  384. Distance to goal: 0.850306
  385. current.linear.x: 0.2
  386. current.linear.y: 0
  387. Checking if goal is reached...
  388. Distance to goal: 0.850306
  389. current.linear.x: 0.2
  390. current.linear.y: 0
  391. Checking if goal is reached...
  392. Distance to goal: 0.62768
  393. current.linear.x: 0.2
  394. current.linear.y: 0.000587972
  395. Checking if goal is reached...
  396. Distance to goal: 0.62768
  397. current.linear.x: 0.2
  398. current.linear.y: 0.000486369
  399. Checking if goal is reached...
  400. Distance to goal: 0.62768
  401. current.linear.x: 0.2
  402. current.linear.y: 0.000320695
  403. Checking if goal is reached...
  404. Distance to goal: 0.346434
  405. current.linear.x: 0.2
  406. current.linear.y: 0
  407. Checking if goal is reached...
  408. Distance to goal: 0.346434
  409. current.linear.x: 0.133333
  410. current.linear.y: 0
  411. Checking if goal is reached...
  412. Distance to goal: 0.346434
  413. current.linear.x: 0.0888889
  414. current.linear.y: 0.000493234
  415. Checking if goal is reached...
  416. Distance to goal: 0.346434
  417. current.linear.x: 0.0888889
  418. current.linear.y: 0.000365244
  419. Checking if goal is reached...
  420. Distance to goal: 0.0807508
  421. current.linear.x: 0
  422. current.linear.y: 0
  423. [ INFO] [1728616638.201756737, 91.400000000]: Goal 2 reached, proceeding to the next goal after 2 seconds...
  424. End Point set to X: -2.3728 Y: 0.2853
  425. Distance to goal: 5.80416
  426. current.linear.x: 0
  427. current.linear.y: 0
  428. Checking if goal is reached...
  429. Distance to goal: 5.81762
  430. current.linear.x: 0
  431. current.linear.y: 0
  432. Checking if goal is reached...
  433. Distance to goal: 5.81928
  434. current.linear.x: 0
  435. current.linear.y: 0
  436. Checking if goal is reached...
  437. Distance to goal: 5.82484
  438. current.linear.x: 0
  439. current.linear.y: 0
  440. Checking if goal is reached...
  441. Distance to goal: 5.82484
  442. current.linear.x: 0
  443. current.linear.y: 0
  444. Checking if goal is reached...
  445. Distance to goal: 5.81799
  446. current.linear.x: 0
  447. current.linear.y: 0
  448. Checking if goal is reached...
  449. Distance to goal: 5.81799
  450. current.linear.x: 0
  451. current.linear.y: 0
  452. Checking if goal is reached...
  453. Distance to goal: 5.81799
  454. current.linear.x: 0
  455. current.linear.y: 0
  456. Checking if goal is reached...
  457. Distance to goal: 5.81799
  458. current.linear.x: 0.4
  459. current.linear.y: 0
  460. Checking if goal is reached...
  461. Distance to goal: 5.81799
  462. current.linear.x: 0.3
  463. current.linear.y: 0
  464. Checking if goal is reached...
  465. Distance to goal: 5.68547
  466. current.linear.x: 0.3
  467. current.linear.y: 0
  468. Checking if goal is reached...
  469. Distance to goal: 5.68547
  470. current.linear.x: 0.3
  471. current.linear.y: 0
  472. Checking if goal is reached...
  473. Distance to goal: 5.49241
  474. current.linear.x: 0.3
  475. current.linear.y: 0
  476. Checking if goal is reached...
  477. Distance to goal: 5.49241
  478. current.linear.x: 0.3
  479. current.linear.y: 0
  480. Checking if goal is reached...
  481. Distance to goal: 5.29178
  482. current.linear.x: 0.3
  483. current.linear.y: 0
  484. Checking if goal is reached...
  485. Distance to goal: 5.0694
  486. current.linear.x: 0.4
  487. current.linear.y: 0
  488. Checking if goal is reached...
  489. Distance to goal: 4.87633
  490. current.linear.x: 0.5
  491. current.linear.y: 0
  492. Checking if goal is reached...
  493. Distance to goal: 4.87633
  494. current.linear.x: 0.6
  495. current.linear.y: 0
  496. Checking if goal is reached...
  497. Distance to goal: 4.41021
  498. current.linear.x: 0.7
  499. current.linear.y: 0
  500. Checking if goal is reached...
  501. Distance to goal: 4.19387
  502. current.linear.x: 0.5
  503. current.linear.y: 0.000859475
  504. Checking if goal is reached...
  505. Distance to goal: 3.91224
  506. current.linear.x: 0.5
  507. current.linear.y: 0.00314842
  508. Checking if goal is reached...
  509. Distance to goal: 3.65036
  510. current.linear.x: 0.5
  511. current.linear.y: 0
  512. Checking if goal is reached...
  513. Distance to goal: 3.37485
  514. current.linear.x: 0.6
  515. current.linear.y: 2.18187e-05
  516. Checking if goal is reached...
  517. Distance to goal: 3.15059
  518. current.linear.x: 0.5
  519. current.linear.y: 0
  520. Checking if goal is reached...
  521. Distance to goal: 2.9389
  522. current.linear.x: 0.5
  523. current.linear.y: 0
  524. Checking if goal is reached...
  525. Distance to goal: 2.68632
  526. current.linear.x: 0.5
  527. current.linear.y: 0
  528. Checking if goal is reached...
  529. Distance to goal: 2.45377
  530. current.linear.x: 0.5
  531. current.linear.y: 0
  532. Checking if goal is reached...
  533. Distance to goal: 2.21385
  534. current.linear.x: 0.6
  535. current.linear.y: 0
  536. Checking if goal is reached...
  537. Distance to goal: 1.94299
  538. current.linear.x: 0.7
  539. current.linear.y: 0
  540. Checking if goal is reached...
  541. Distance to goal: 1.72702
  542. current.linear.x: 0.5
  543. current.linear.y: -0.000687903
  544. Checking if goal is reached...
  545. Distance to goal: 1.55254
  546. current.linear.x: 0.3
  547. current.linear.y: 0
  548. Checking if goal is reached...
  549. Distance to goal: 1.35505
  550. current.linear.x: 0.3
  551. current.linear.y: 0
  552. Checking if goal is reached...
  553. Distance to goal: 1.17794
  554. current.linear.x: 0.3
  555. current.linear.y: 0
  556. Checking if goal is reached...
  557. Distance to goal: 1.17794
  558. current.linear.x: 0.2
  559. current.linear.y: 0
  560. Checking if goal is reached...
  561. Distance to goal: 0.958262
  562. current.linear.x: 0.2
  563. current.linear.y: 0
  564. Checking if goal is reached...
  565. Distance to goal: 0.958262
  566. current.linear.x: 0.2
  567. current.linear.y: 0
  568. Checking if goal is reached...
  569. Distance to goal: 0.958262
  570. current.lin