Closed aislab closed 6 years ago
このMarkerArrayは,両腕の間に出てくる緑の線分状のマーカだと思います.手元でシミュレータで試すと,エラーも表示されずマーカは表示されます.実機で起動した際に,このエラーが表示されました.
/collistion_detector_marker_arrayを発行しているのは,collision_stateノードで,これは,hrpsys_ros_bridge/launch/collision_detector.launchで起動されています.
現地で記録しておけばよかったのですが,直接の原因は/collision_detector_marker_arrayのframe_idが"WAIST_Link"になっているためだと思います.ロボットモデルには"WAIST_Link"というリンクは存在しないのではと思います.
実機でこのエラーが出る時の情報を教えてもらえないでしょうか > @aislab 何が必要かよく分かりませんが,とりあえず,
$ rostopic echo /collision_detector_marker_array
$ rosparam get /robot_description
の結果あたりを.
あと一応,ワークスペースが使われていないこと(roscd したら/optに行くこと)をもう一度確認してみてください.
以下の環境で実行しました.
$ lsb_release -a
No LSB modules are available.
Distributor ID: Ubuntu
Description: Ubuntu 16.04.3 LTS
Release: 16.04
Codename: xenial
$ rosversion -d
kinetic
$ rostopic echo /collision_detector_marker_array
$ rosparam get /robot_description
の実行結果です. robot_descriptionについては数値のみの部分は省略しています.
0 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\ ... \ 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842\ \ 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853
\n\t\t\t\t180 1 0 180 2 1 180 3 2 180 4 3 180 5 4 180 6 5 180\ \ 7 6 180 8 7 180 9 8 180 10 9 180 11 10 180 12 11 180 13 12 180 14 13 180 15 14\ ... \ 168 181 168 169 181 169 170 181 170 171 181 171 172 181 172 173 181 173 174 181\ \ 174 175 181 175 176 181 176 177 181 177 178 181 178 179 181 179 160
\n\t\t\t\ \t0 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\ ... \ 13292 13293 13294 13295 13296 13297 13298 13299 13300 13301 13302 13303 13304\ \ 13305 13306 13307
\n\t\t\t\t0 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\ ... \ 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024 3025 3026\ \ 3027 3028 3029 3030 3031 3032 3033 3034 3035
\n\t\t\t\t0 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\ ... \ 4755 4756 4757 4758 4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770\ \ 4771 4772 4773 4774 4775
\n\t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12\ \ 14 16 15 17 19 18 20 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40\ ... \ 2051 2053 2052 2054 2056 2055 2057 2059 2058 2060 2062 2061 2063 2065 2064 2066\ \ 2068 2067 2069
\n\t\t\t\t99 500 603 340 527 54 613 491 36 608 192 578 184 53\ \ 594 305 292 522 648 674 621 292 445 671 164 155 258 657 383 93 383 18 181 167\ ... \ 862 979 894 986 968 957 874 872 932 923 964 946 955 970 918 943 963 982 989 868\ \ 984 983 959
\n\t\t\t\t90 122 20 100 106 78 179 48 219\ \ 207 237 163 124 116 98 230 65 56 13 188 169 47 241 65 235 124 98 51 37 148 145\ ... \ 325 331 330 329 331 332 330 330 332 328 340 335 336 334 333 337 338 335 340 335\ \ 334 342 339 334 337 333 338 341 338 340 341 334 339 342 333 341 337 335 338 333\ \ 335 342 336 334 335 333
\n\t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12 14 16 15 17 19 18 20\ \ 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40 39 41 43 42 44 46 45\ ... \ 3431 3433 3432 3434 3436 3435 3437 3439 3438 3440 3442 3441 3443 3445 3444 3446\ \ 3448 3447 3449 3451 3450 3452 3454 3453 3455 3457 3456 3458 3460 3459 3461 3463\ \ 3462 3464
\n\t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12 14 16 15 17 19 18 20\ \ 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40 39 41 43 42 44 46 45\ ... \ 3078 3080 3082 3081 3083 3085 3084 3086 3088 3087 3089 3091 3090 3092 3094 3093\ \ 3095 3097 3096 3098 3100 3099 3101
\n\t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12 14 16 15 17 19 18 20 22 21 23\ \ 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40 39 41 43 42 44 46 45 47 49 48\ ... \ 3801 3803 3805 3804 3806 3808 3807 3809 3811 3810 3812 3814 3813 3815 3817 3816\ \ 3818 3820 3819 3821 3823 3822 3824 3826 3825 3827
\n\t\t\t\t0 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\ ... \ 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250\ \ 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
\n\ \t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12\ \ 14 16 15 17 19 18 20 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40\ \ 39 41 43 42 44 46 45 47 49 48 50 52 51 53 55 54 56 58 57 59 61 60 62 64 63 65\ ... \ 1235 1237 1236 1238 1240 1239 1241 1243 1242 1244 1246 1245 1247 1249 1248 1250\ \ 1252 1251 1253 1255 1254 1256 1258 1257 1259 1261 1260 1262 1264 1263 1265
\n\ \t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12\ \ 14 16 15 17 19 18 20 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40\ \ 39 41 43 42 44 46 45 47 49 48 50 52 51 53 55 54 56 58 57 59 61 60 62 64 63 65\ ... \ 1410 1412 1414 1413 1415 1417 1416 1418 1420 1419 1421 1423 1422 1424 1426 1425\ \ 1427 1429 1428 1430 1432 1431 1433 1435 1434 1436 1438 1437 1439
\n\t\t\t\t\0 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\ ... \ 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066\ \ 2067 2068 2069
\n\t\t\t\t500 99 603 527 340 54 491 613\ \ 36 192 608 578 53 184 594 292 305 522 674 648 621 445 292 671 155 164 258 383\ ... \ 876 894 882 946 961 896 974 976 987 961 889 891 879 862 878 979 986 894 968 874\ \ 957 872 923 932 964 955 946 970 943 918 963 989 982 868 983 984 959
\n\t\t\t\ \t122 90 20 106 100 78 48 179 219 237 207 163 116 124 98 65 230\ \ 56 188 13 169 241 47 65 124 235 98 37 51 148 19 145 195 6 164 170 189 209 180\ ... \ 332 330 328 335 340 336 333 334 337 335 338 340 334 335 342 334 339 337 338 333\ \ 341 340 338 341 339 334 342 341 333 337 338 335 333 342 335 336 335 334 333
\n\ \t\t\t\t0 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\ ... \ 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458\ \ 3459 3460 3461 3462 3463 3464
\n\t\t\t\t0 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\ ... \ 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094\ \ 3095 3096 3097 3098 3099 3100 3101
\n\t\t\t\t0 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\ ... \ 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826\ \ 3827
\n\t\t\t\t0 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\ ... \ 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265
\n\ \t\t\t\t0 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\ ... \ 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478\ \ 479
\n\t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12\ \ 14 16 15 17 19 18 20 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40\ ... \ 1252 1251 1253 1255 1254 1256 1258 1257 1259 1261 1260 1262 1264 1263 1265
\n\ \t\t\t\t1 0 2 4 3 5 7 6 8 10 9 11 13 12\ \ 14 16 15 17 19 18 20 22 21 23 25 24 26 28 27 29 31 30 32 34 33 35 37 36 38 40\ \ 39 41 43 42 44 46 45 47 49 48 50 52 51 53 55 54 56 58 57 59 61 60 62 64 63 65\ ... \ 1410 1412 1414 1413 1415 1417 1416 1418 1420 1419 1421 1423 1422 1424 1426 1425\ \ 1427 1429 1428 1430 1432 1431 1433 1435 1434 1436 1438 1437 1439
\n\t\t\t\t\やはり,HiroNXのモデルと,collision_statesノードの想定しているWAISTリンクの名前が違うのが問題のようです.HiroNXのモデルファイルは,ロボットの体内のQNX側にありそちらを変更するのは難しいので,とりあえず,
rosrun tf static_transform_publisher 0 0 0 0 0 0 /WAIST /WAIST_Link 1
とWAIST_Link座標系を追加すると,エラーがなくなるのではないかと思うので,試してみてもらえないでしょうか.
もしこれで上手く行くようでしたら,ややアドホックですが,これをhironx_ros_bridge_real.launchに入れると良いです.その場合PRを出してもらえると助かります.
実機環境にて
rosrun tf static_transform_publisher 0 0 0 0 0 0 /WAIST /WAIST_Link 1
を実行するとエラーは消えました.
ありがとうございます.
HiroNXで画像のようにエラーになります。 パッケージは、Indigoリリースです。 WAIST_Linkというリンクはロボットは持っていないようなのですが、どこを変更すればこのエラーが消えるでしょうか。