Skip to content

OpenSource-ubicomp/iahrs_driver

ย 
ย 

Folders and files

NameName
Last commit message
Last commit date

Latest commit

ย 

History

30 Commits
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 
ย 

Repository files navigation

iAHRS ROS Package

===[Device Setting]====================================

-iAHRS๋Š” USB๋กœ ์—ฐ๊ฒฐ๋˜๋Š”๋ฐ ์ƒํ™ฉ์— ๋”ฐ๋ผ์„œ ์ธ์‹๋˜๋Š” ttyUSB ํฌํŠธ์˜ ๋ฒˆํ˜ธ๊ฐ€ ๋ฐ”๋€” ์ˆ˜ ์žˆ์Œ์œผ๋กœ ์žฅ์น˜ ์ด๋ฆ„์„ ๊ณ ์ •ํ•ด์„œ ์‚ฌ์šฉํ• ๊ฒŒ์š”.

  1. ttyUSB๊ถŒํ•œ ์„ค์ •.

USB Port์— ๋Œ€ํ•œ ๊ถŒํ•œ์€ โ€˜sudo chmod 777 ttyUSB0โ€™ ๋ช…๋ น์–ด๋ฅผ ํ†ตํ•ด์„œ ์ค„ ์ˆ˜ ์žˆ์ง€๋งŒ, ๋งค๋ฒˆ ์„ค์ •์ด ๋ฒˆ๊ฑฐ๋กœ์šฐ๋ฏ€๋กœ dialout๊ทธ๋ฃน์— ์ถ”๊ฐ€ํ•˜๋Š” ๋ฐฉ๋ฒ•์„ ์ด์šฉ.

๏ƒจ sudo usermod -a -G dialout $USER

  1. ttyUSB rule์˜ ์„ค์ •์„ ์œ„ํ•œ ์‹ฌ๋ณผ๋ฆญ ๋งํฌ ttyUSBx๋งŒ๋“ค๊ธฐ
  • ์‹ฌ๋ณผ๋ฆญ ๋งํฌ๋ฅผ ๋งŒ๋“œ๋Š”๋ฐ ํ•„์š”ํ•œ ์ •๋ณด๋Š” ์•„๋ž˜ 3๊ฐ€์ง€.

๏ฌ Vender ID

๏ฌ Product ID

๏ฌ Serial Number

  • ์œ„์˜ 3๊ฐ€์ง€ ์ •๋ณด๋Š” ์•„๋ž˜ 2๊ฐœ์˜ ๋ช…๋ น์–ด๋กœ ์ฐพ์„ ์ˆ˜ ์žˆ์–ด์š”.

๏ƒจ $ lsusb

๏ƒจ $ udevadm info -a /dev/ttyUSB0 | grep '{serial}' <-- ์ €๋Š” ์ฒ˜์Œ์— iAHRS๊ฐ€ ttyUSB0์œผ๋กœ ์žกํ˜€์„œ ์ด๋ ‡๊ฒŒ ํ–ˆ์–ด์š”. ๋งŒ์•ฝ ๋ฒˆํ˜ธ๊ฐ€ ๋‹ค๋ฅด๋ฉด ๊ทธ ๋ฒˆํ˜ธ๋ฅผ ์ž…๋ ฅํ•˜์„ธ์š”.

id

์œ„์— ์ถœ๋ ฅ๋œ ์ •๋ณด๊ฐ€ USB to Serial Device์˜ Serial Number์ด๋ฉฐ, ํ•ด๋‹น ๋ฒˆํ˜ธ๋Š” ์ œํ’ˆ๋ณ„๋กœ ๋‹ค๋ฅผ ์ˆ˜๋„ ์žˆ์Šต๋‹ˆ๋‹ค.

  • ์•Œ์•„๋‚ธ ์ •๋ณด๋ฅผ ์ด์šฉํ•œ .rules file์ƒ์„ฑ.

โ€˜IMU.rulesโ€™ ํŒŒ์ผ์„ โ€˜/etc/udev/rules.dโ€™ ๊ฒฝ๋กœ์— ์ƒ์„ฑํ•œ ํ›„์— ํ•ด๋‹น ํŒŒ์ผ์˜ ๋‚ด์šฉ์„ ์•„๋ž˜์™€ ๊ฐ™์ด ์ž‘์„ฑํ•œ ํ›„ ์ €์žฅ.

KERNEL=="ttyUSB*", ATTRS{idVendor}=="0403", ATTRS{idProduct}=="6015", ATTRS{serial}=="DM03L0C6", MODE:="0666", GROUP:="dialout", SYMLINK+="IMU"

  • udev ์žฌ์‹œ์ž‘ ๋ช…๋ น์–ด๋ฅผ ํ˜ธ์ถœํ•œ ํ›„์— PC์˜ ์žฌ ์‹œ์ž‘์„ ํ•ด์ฃผ์–ด์•ผ ์ ์šฉ ๋ฉ๋‹ˆ๋‹ค.

๏ƒจ $ sudo service udev restart

rules

  • ์‹ฌ๋ณผ๋ฆญ ๋“ฑ๋ก์˜ ํ™•์ธ. (์•„๋ž˜์™€ ๊ฐ™์€ ๋ช…๋ น์–ด๋ฅผ ํ˜ธ์ถœํ•˜๋ฉด ์œ„์˜ ๊ทธ๋ฆผ์ฒ˜๋Ÿผ ttyUSB๊ฐ€ IMU๋กœ ๊ณ ์ •๋œ ๊ฒƒ์„ ๋ณผ ์ˆ˜ ์žˆ์–ด์š” .)

๏ƒจ $ ll /dev/

===[์‚ฌ์šฉํ•˜๊ธฐ]====================================

  1. roslaunch ํ•˜๊ธฐ

๏ƒจ $ roslaunch iahrs_driver iahrs_driver.launch

  1. imu topicํ™•์ธํ•˜๊ธฐ

๏ƒจ $ rostopic echo /imu/data 222

  1. rviz๋ฅผ ์‚ฌ์šฉํ•˜์—ฌ ํ™•์ธํ•˜๊ธฐ

๏ƒจ $ rviz

  • rvizํ™”๋ฉด์„ ์•„๋ž˜์™€ ๊ฐ™์ด ์„ค์ •

rviz_setting

  • ๋™์ž‘์— ๋Œ€ํ•œ ์˜์ƒ์€ ๋ฐ”๋กœ ์•„๋ž˜~~~

ezgif com-crop

  1. ์‚ฌ์šฉ ๊ฐ€๋Šฅํ•œ ์„œ๋น„์Šค (Input: ์—†์Œ)
  • all_data_reset_cmd : ๋ชจ๋“  ๋ณด์ • ๋ฐ์ดํ„ฐ ์ดˆ๊ธฐํ™”(c=9)

  • euler_angle_init_cmd: ํ˜„์žฌ Euler angle์„ 0์œ„์น˜๋กœ ์„ค์ •(c=5)

  • euler_angle_reset_cmd: Euler angle์ดˆ๊ธฐํ™” (c=7)

  • pose_velocity_reset_cmd: ์œ„์น˜์™€ ์†๋„ ์ดˆ๊ธฐํ™” (c=8)

  • reboot_sensor_cmd: ์„ผ์„œ ์žฌ์‹œ์ž‘(c=99)

About

iahrs ros package

Resources

Stars

Watchers

Forks

Releases

No releases published

Packages

 
 
 

Contributors

Languages

  • C++ 91.2%
  • CMake 8.8%