Day 017.4 - Odometry Model bar indicates odometer...

Info iconThis preview shows pages 1–4. Sign up to view the full content.

View Full Document Right Arrow Icon

Info iconThis preview has intentionally blurred sections. Sign up to view the full version.

View Full DocumentRight Arrow Icon

Info iconThis preview has intentionally blurred sections. Sign up to view the full version.

View Full DocumentRight Arrow Icon
This is the end of the preview. Sign up to access the rest of the document.

Unformatted text preview: Odometry Model bar indicates odometer coordinates Robot moves from Odometry information 2 x , y , to x ' , y ' , ' . u = , . , rot1 rot 2 trans trans = ( x '- x ) + ( y '- y ) 2 rot1 = atan2( y '- y , x '- x ) - rot 2 = '- - rot1 x , y , rot 2 rot1 trans x ' , y ' , ' Noise Model for Odometry The measured motion is given by the true motion corrupted with noise. ^rot1 = rot1 - 2 1 rot 1 + 2 2 trans ^trans = trans - 3 2 2 2 trans + 4 rot 1 + rot 2 ^rot 2 = rot 2 - 2 1 rot 2 + 2 2 trans Sample Odometry Motion Model 1. 1. 2. 3. 4. 5. 6. 7. Algorithm sample_motion_model(u, x): u = rot1 , rot 2 , trans , x = x, y, 2 2 ^rot1 = rot1 + sample(1 rot1 + 2 trans ) 2 2 2 ^trans = trans + sample( 3 trans + 4 ( rot1 + trans )) ^ = + sample( 2 + 2 ) rot 2 rot 2 1 rot 2 2 trans x' = x + ^trans cos( + ^rot1 ) y ' = y + ^trans sin( + ^rot1 ) ' = + ^ + ^ rot1 rot 2 sample_normal_distribution Return x ' , y ' , ' Sampling from Our Motion Model Start ...
View Full Document

Page1 / 4

Day 017.4 - Odometry Model bar indicates odometer...

This preview shows document pages 1 - 4. Sign up to view the full document.

View Full Document Right Arrow Icon
Ask a homework question - tutors are online