Obstacle Message - Explanation
Scoeerg opened this issue · comments
Hi
Some questions about the obstacle message. For reference, here's what an obstacle message looks like:
unique_identifier_msgs/UUID uuid
float32 score # detection confidence
geometry_msgs/Point position # center
geometry_msgs/Vector3 velocity
geometry_msgs/Vector3 size
- which tells me an obstacle is a rectangle with
size
x_size,y_size,z_size
aposition
x,y,z
. Is sizex_size,y_size,z_size
a cube with volume2x_size*2y_size*2z_size
:
![position_size](https://private-user-images.githubusercontent.com/46482636/287040051-5d38c3ef-6582-4b31-895e-3ae2a4da44b5.png?jwt=eyJhbGciOiJIUzI1NiIsInR5cCI6IkpXVCJ9.eyJpc3MiOiJnaXRodWIuY29tIiwiYXVkIjoicmF3LmdpdGh1YnVzZXJjb250ZW50LmNvbSIsImtleSI6ImtleTUiLCJleHAiOjE3MjAwOTI5MDgsIm5iZiI6MTcyMDA5MjYwOCwicGF0aCI6Ii80NjQ4MjYzNi8yODcwNDAwNTEtNWQzOGMzZWYtNjU4Mi00YjMxLTg5NWUtM2FlMmE0ZGE0NGI1LnBuZz9YLUFtei1BbGdvcml0aG09QVdTNC1ITUFDLVNIQTI1NiZYLUFtei1DcmVkZW50aWFsPUFLSUFWQ09EWUxTQTUzUFFLNFpBJTJGMjAyNDA3MDQlMkZ1cy1lYXN0LTElMkZzMyUyRmF3czRfcmVxdWVzdCZYLUFtei1EYXRlPTIwMjQwNzA0VDExMzAwOFomWC1BbXotRXhwaXJlcz0zMDAmWC1BbXotU2lnbmF0dXJlPTcwODljODQ4MDZiYTM3ZTdmODM1N2M2NWY5ODAzYjY3MDdmYTk4YzM2N2VlOGMzZDZiZDZiYzliMGVmZTBhY2ImWC1BbXotU2lnbmVkSGVhZGVycz1ob3N0JmFjdG9yX2lkPTAma2V5X2lkPTAmcmVwb19pZD0wIn0.WuybDHyxJJlOoraFwFh90GntC14bKzeuYFVo01ebuOE)
or with volume x_size*y_size*z_size
?
- Now, most obstacles are not rectangle/cube-shaped. In standard navigation obstacles looks like a bunch of pixels (3D voxels). How does navigation_dynamic generate the rectangle (3D Cube)? E.g. human legs in a 2D-map (top-down-view) might look like (with
resolution=0.10
, i.e.1px/0.1m
) this:
![top_down_rectangle_creation](https://private-user-images.githubusercontent.com/46482636/287042261-e4cd6b6b-7790-435e-b157-c38b0b5ec211.png?jwt=eyJhbGciOiJIUzI1NiIsInR5cCI6IkpXVCJ9.eyJpc3MiOiJnaXRodWIuY29tIiwiYXVkIjoicmF3LmdpdGh1YnVzZXJjb250ZW50LmNvbSIsImtleSI6ImtleTUiLCJleHAiOjE3MjAwOTI5MDgsIm5iZiI6MTcyMDA5MjYwOCwicGF0aCI6Ii80NjQ4MjYzNi8yODcwNDIyNjEtZTRjZDZiNmItNzc5MC00MzVlLWIxNTctYzM4YjBiNWVjMjExLnBuZz9YLUFtei1BbGdvcml0aG09QVdTNC1ITUFDLVNIQTI1NiZYLUFtei1DcmVkZW50aWFsPUFLSUFWQ09EWUxTQTUzUFFLNFpBJTJGMjAyNDA3MDQlMkZ1cy1lYXN0LTElMkZzMyUyRmF3czRfcmVxdWVzdCZYLUFtei1EYXRlPTIwMjQwNzA0VDExMzAwOFomWC1BbXotRXhwaXJlcz0zMDAmWC1BbXotU2lnbmF0dXJlPWFlNWI1MDk4ZWJjZGZmZTI2Y2UyOWM2YjNlMTkxMmIzZjMyNTcyODA0MTlmZTFhOTg2MzgwY2I5MzkxNTYwY2UmWC1BbXotU2lnbmVkSGVhZGVycz1ob3N0JmFjdG9yX2lkPTAma2V5X2lkPTAmcmVwb19pZD0wIn0.Ih6yLwO-Ix8rsp7FwRVRL6u4PVUDyCx5LzjZ-BCKMi8)
Is this even how it works?
- Is the score (detection confidence) related to the covariance matrix from the Kalman filters used for obstacle position/velocity estimation or related to the Hungarian tracker (of which I know very little besides the Wiki linked in the README tbh)? And how?
Disclaimer: I will ask (and hopefully answer) some questions that I have in the issues, since not many people seem to be interested (yet). I am however very grateful navigation2_dynamic exists.