Các cảm biến chuyển động là bộ mã hóa quay gắn trên hai bánh xe điều khiển. Các dữ liệu mã hóa được nhận từ phần cứng điều khiển và ước tính vị trí của xe lăn dựa trên mô hình động học mô tả trong phần II.B trên. Một khi dữ liệu mã hóa được nhận được, chúng được lưu trữ trong bộ đệm để chế biến tiếp. Các khung dữ liệu mã hóa là hai byte trong đó lưu trữ các số xung của bánh trái và phải. chức năng Odometry được thực hiện định kỳ cho mỗi 0.02s. Biểu đồ của thuật toán nội địa hóa odometry dựa trên được khái quát trong hình 3, trong đó các dữ liệu từ các cảm biến bánh xe chuyển động được sử dụng để ước tính sự thay đổi trong vị trí của bánh xe đối tượng theo thời gian với các thông số tương ứng: m_per_pulse là 0.33mm; wheel_base là 0.52m (khoảng cách giữa hai bánh xe điều khiển); dr và dl là khoảng cách đi bên phải và bánh xe còn lại trong thời gian 0.02s và x, y, là θ vị trí và hướng của xe lăn. Lưu ý rằng atan2 chức năng được gọi là để đảm bảo rằng θ là bình thường trong khoảng [-π, π].
đang được dịch, vui lòng đợi..
