ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航

117
0
2020年9月8日 10时28分

一、安装

语音识别安装参考文章:安装教程

二、准备工作

如果没有安装turtlebot3的话需要先进行安装,可以参考我前面的博客:传送门

2.1 机器人位置初始化

本节博客要做的是利用科大讯飞的开源语音识别来导航turtlebot,也是展示服务机器人最基本的功能之一吧,那么要做到人工智能,像我在《ros机器人编程实践(7)》中写的使用rviz的2D pose Estimate来人工标定机器人在rviz中的初始位置显然是不合理的,所以首先编写脚本初始化位置,然后加入到启动rviz的launch文件中。

2.1.1 查看初始化位置的话题详情

启动仿真环境:

roslaunch turtlebot3_gazebo turtlebot3_world.launch

 

启动rviz:

roslaunch turtlebot3_navigation turtlebot3_navigation.launch map_file:=$HOME/map.yaml

 

查看turtlebot的所有话题:

rostopic list

 

ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航插图

 

虽然我英文不咋好,但是还是看懂了/initialpose哈哈哈哈~

 

ok查看这个话题的详情:

rostopic info /initialpose

 

ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航插图(1)

 

[1]消息类型是Type: geometry_msgs/PoseWithCovarianceStamped

[2]发布者是rviz

[3]使用者是amcl也就是定位的软件

然后查看这个消息的详情:

 

rosmsg info geometry_msgs/PoseWithCovarianceStamped

 

ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航插图(2)

 

这里可以看明白层级关系了吧!

修改坐标x则:对象.pose.pose.position.x

修改四元数x则:对象.pose.pose.orientation.x

2.1.2 初始化位置脚本

ok假装你也看懂了,下面来写初始化的脚本:

sudo gedit ~/wanderbot_ws/src/wanderbot/src/initial_localization.py

 

#!/usr/bin/env python
import sys, rospy, tf, actionlib
from geometry_msgs.msg import *
from tf.transformations import quaternion_from_euler

if __name__ == '__main__':
  rospy.init_node('initial_localization')
  pub = rospy.Publisher('initialpose', PoseWithCovarianceStamped, queue_size=1)
  p = PoseWithCovarianceStamped()
  p.header.frame_id = "map"
  p.pose.pose.position.x = -2
  p.pose.pose.position.y = -0.5
  p.pose.pose.position.z = 0
  p.pose.pose.orientation = Quaternion(*quaternion_from_euler(0, 0, 0))
  p.pose.covariance = \
    [ 0.1 , 0,    0, 0, 0, 0,
      0   , 0.1 , 0, 0, 0, 0,
      0   , 0   , 0, 0, 0, 0,
      0   , 0   , 0, 0, 0, 0,
      0   , 0   , 0, 0, 0, 0,
      0   , 0   , 0, 0, 0, 0.1 ]
  for t in range(0,5):
    rospy.sleep(1)
    pub.publish(p)

 

2.1.3 修改启动rviz的launch文件

roscd turtlebot3_navigation
cd launch/
ls
sudo gedit turtlebot3_navigation.launch 

 

在最底下加上:

 

  <!-- init -->
  <node pkg="wanderbot" name="initial_localization" 
    type="initial_localization.py" output="screen">
  </node>

 

 

ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航插图(3)

 

2.1.4 启动rviz的launch文件测试结果

roslaunch turtlebot3_navigation turtlebot3_navigation.launch map_file:=$HOME/map.yaml

 

ros机器人编程实践(15.1)- 使用科大讯飞语音控制turtlebot导航插图(4)

 

可以看到效果很好,避免了人工摆放的随机误差。

发表评论

后才能评论