# rasp_imu_hat_6dof

为树莓派IMU扩展板创建的代码仓库，直接将该软件包源码放在ROS工作区src目录下即可。然后使用catkin_make就可以进行编译了。

----
## 使用串口发布IMU数据
当编译完成后可以使用如下命令启动发布imu数据:  
`roslaunch serial_imu_hat_6dof serial_imu_hat.launch`  
当启动上述命令后,可以在ROS中查看到如下话题和服务可以调用:  
* 发布imu数据的话题名: /imu_data
* 发布imu模块温度的话题名: /imu_temp
* 发布yaw角度的话题名: /yaw_data
* 可将yaw角度归零的话题名: /yaw_zero_topic
* 可将yaw角度归零的服务名: /yaw_zero_service
* 可修改串口波特率的服务: /baud_update_service
* 控制D0,D1,D2,D3输出数字高低电平的服务: /pin_outHL_service  
对于以上这些话题名和服务名,都可以在serial_imu_hat_6dof/cfg/param.yaml配置文件中进行修改.  

如果想使用话题方式,将yaw角度归零,那就可以执行如下命令:  
`rostopic pub -1 /yaw_zero_topic std_msgs/Empty "{}"`  

如果想使用服务调用方式,将yaw角度归零,那执行如下命令:  
`rosservice call /yaw_zero_service "{}"`  

如果想修改串口通信的波特率,那就可以执行如下命令:  
`rosservice call /baud_update_service "index: 1"`  
这里需要注意index后面的数字,１表示更新波特率为9600,2表示为57600,3表示115200,
当更新完波特率后,需要修改本地配置文件中串口波特率为新的,否则会无法正常获取imu数据.  

如果需要控制D0引脚输出高电平,那就可以使用如下命令:  
rosservice call /pin_outHL_service "D0: 1  
D1: 0  
D2: 0  
D3: 0"  
这里可以看到D0后面的数字为1,那就表明D0引脚输出高电平.若想修改其他引脚的高低电平状态,那就修改D0,D1,D2,D3后面的对应数字即可.  


----
## 使用IIC发布IMU数据
`roslaunch rasp_imu_hat_6dof imu_data_pub.launch`

----
## 在Rviz中显示查看IMU效果
`roslaunch rasp_imu_hat_6dof imu_rviz_display.launch`