๐Ÿ™‰B.4 State Estimation

state estimation แ€™แ€พแ€ฌแ€•แ€ซแ€แ€„แ€บแ€›แ€™แ€Šแ€บแ€ท แ€กแ€“แ€ญแ€€ แ€”แ€พแ€…แ€บแ€แ€ฏแ€€แ€แ€ฑแ€ฌแ€ท transformation แ€”แ€พแ€…แ€บแ€แ€ฏแ€•แ€ซแ€•แ€ฒแ‹ แ€žแ€ญแ€แ€ฒแ€ทแ€•แ€ผแ€ฎแ€ธแ€แ€ฒแ€ทแ€กแ€แ€ญแ€ฏแ€„แ€บแ€ธ map => odom ( from positioning system ) แ€”แ€ฒแ€ท odom => base_link ( from odometry system ) แ€•แ€ฑแ€ซแ€ทแ€—แ€ปแ€ฌแ‹

Positioning System

Position System แ€™แ€พแ€ฌแ€†แ€ญแ€ฏแ€›แ€„แ€บแ€แ€ฑแ€ฌแ€ท Nav 2 แ€”แ€ฒแ€ท แ€แ€ฝแ€ฒแ€žแ€ฏแ€ถแ€ธแ€–แ€ญแ€ฏแ€ท Adaptive Monte-Carlo Localization technique แ€€แ€ญแ€ฏแ€œแ€ฏแ€•แ€บแ€•แ€ฑแ€ธแ€‘แ€ฌแ€ธแ€แ€šแ€บแ‹ แ€žแ€ฐแ€€ map => odom แ€€แ€ญแ€ฏแ€‘แ€ฏแ€แ€บแ€•แ€ฑแ€ธแ€™แ€พแ€ฌแ‹

แ€žแ€ฐแ€ทแ€œแ€ญแ€ฏแ€ทแ€•แ€ฒ แ€œแ€ฏแ€•แ€บแ€•แ€ฑแ€ธแ€”แ€ญแ€ฏแ€„แ€บแ€แ€ฌแ€€ slamtoolbox แ€•แ€ฑแ€ซแ€ทแ‹ แ€žแ€ฐแ€€แ€แ€ฑแ€ฌแ€ท position แ€กแ€•แ€ผแ€„แ€บ map แ€€แ€ญแ€ฏแ€•แ€ซ แ€‘แ€ฏแ€แ€บแ€•แ€ฑแ€ธแ€”แ€ญแ€ฏแ€„แ€บแ€•แ€ซแ€แ€šแ€บแ‹

แ€กแ€ฒแ€ทแ€แ€ฑแ€ฌแ€ท แ€แ€€แ€šแ€บแ€€ positioning system แ€™แ€พแ€ฌแ€‘แ€ฏแ€แ€บแ€•แ€ฑแ€ธแ€”แ€ฑแ€แ€ฌแ€€ position , map , metadata แ€แ€ฝแ€ฑแ€›แ€ฑแ€ฌแ€•แ€ซแ€•แ€ซแ€แ€šแ€บแ‹ แ€’แ€ซแ€•แ€ฑแ€™แ€ฒแ€ท แ€กแ€›แ€ฑแ€ธแ€€แ€ผแ€ฎแ€ธแ€†แ€ฏแ€ถแ€ธแ€กแ€แ€ปแ€€แ€บแ€€ แ€’แ€ฎ position แ€แ€ฝแ€ฑแ€žแ€Šแ€บ แ€€แ€ฑแ€ฌแ€„แ€บแ€ธแ€™แ€ฝแ€”แ€บแ€™แ€พแ€”แ€บแ€€แ€”แ€บแ€”แ€ฑแ€–แ€ญแ€ฏแ€ทแ€œแ€ญแ€ฏแ€•แ€ซแ€แ€šแ€บแ‹

Robot แ€™แ€พแ€ฌ Position แ€…แ€”แ€…แ€บแ€กแ€แ€ฝแ€€แ€บ position system แ€กแ€™แ€ปแ€ญแ€ฏแ€ธแ€™แ€ปแ€ญแ€ฏแ€ธแ€›แ€พแ€ญแ€แ€šแ€บแ€†แ€ญแ€ฏแ€›แ€„แ€บแ€แ€ฑแ€ฌแ€ท แ€กแ€ฒแ€ทแ€€แ€ฑแ€ฌแ€„แ€บแ€แ€ฝแ€ฑแ€€แ€ญแ€ฏ fuse แ€œแ€ฏแ€•แ€บแ€•แ€ผแ€ฎแ€ธแ€žแ€ฏแ€ถแ€ธแ€œแ€ญแ€ฏแ€ทแ€›แ€•แ€ซแ€แ€šแ€บแ‹ ekf ( extended Kelman Filter ) แ€œแ€ญแ€ฏแ€€แ€ฑแ€ฌแ€„แ€บแ€แ€ฝแ€ฑแ€”แ€ฒแ€ท fuse แ€œแ€ฏแ€•แ€บแ€•แ€ผแ€ฎแ€ธ robot localization แ€•แ€ผแ€ฏแ€œแ€ฏแ€•แ€บแ€œแ€ญแ€ฏแ€ทแ€›แ€•แ€ซแ€แ€šแ€บแ‹ แ€”แ€ฑแ€ฌแ€€แ€บแ€•แ€ญแ€ฏแ€„แ€บแ€ธแ€€แ€ปแ€›แ€„แ€บ แ€†แ€ฝแ€ฑแ€ธแ€”แ€ฝแ€ฑแ€ธแ€™แ€šแ€บแ‹

Odometry System

แ€”แ€ฑแ€ฌแ€€แ€บแ€แ€แ€ฏแ€€ odom => base_link แ€€แ€ญแ€ฏ แ€‘แ€ฏแ€แ€บแ€•แ€ฑแ€ธแ€™แ€Šแ€บแ€ท odometry system แŠ odom แ€กแ€แ€ฝแ€€แ€บ source แ€แ€ฝแ€ฑแ€€แ€แ€ฑแ€ฌแ€ท lidar, wheel encoder, imu แ€’แ€ซแ€™แ€ปแ€ญแ€ฏแ€ธแ€แ€ฝแ€ฑแ€•แ€ฑแ€ซแ€ทแ‹ odom system แ€›แ€ฒแ€ท แ€›แ€Šแ€บแ€›แ€ฝแ€šแ€บแ€แ€ปแ€€แ€บแ€€ smooth แ€–แ€ผแ€…แ€บแ€•แ€ผแ€ฎแ€ธ continuous แ€–แ€ผแ€…แ€บแ€แ€ฒแ€ท transform frame แ€แ€ฝแ€ฑแ€€แ€ญแ€ฏ แ€‘แ€ฏแ€แ€บแ€•แ€ฑแ€ธแ€–แ€ญแ€ฏแ€ทแ€•แ€ฒแ‹

Last updated