ROS学习笔记—— rospy

所有资料均来自于 https://www.icourse163.org/learn/ISCAS-1002580008#/learn/announce  和

https://github.com/DroidAITech/ROS-Academy-for-Beginners  和 

https://sychaichangkun.gitbooks.io/ros-tutorial-icourse163/content/

rospy具体接口:https://docs.ros.org/api/rospy/html/

ROS Wiki rospy介绍:https://wiki.ros.org/rospy 

 

rospy中和 Node Topic Service Param Time 相关的函数

rospy_Node 相关

返回值 方法 作用
  rospy.init_node(name, argv=None, anonymous=False) 注册和初始化node
MasterProxy rospy.get_master() 获取master的句柄
bool rospy.is_shutdown() 节点是否关闭
  rospy.on_shutdown(fn) 在节点关闭时调用fn函数
str get_node_uri() 返回节点的URI
str get_name() 返回本节点的全名
str get_namespace() 返回本节点的名字空间

初始化node

import rospy
rospy.init_node('my_node')

rospy_Topic 相关

函数:

返回值 方法 作用
[[str, str]] get_published_topics() 返回正在被发布的所有topic名称和类型
Message wait_for_message(topic, topic_type, time_out=None) 等待某个topic的message
  spin() 触发topic或service的回调/处理函数,会阻塞直到关闭节点

注:rospy里没有 spinOnce() 函数 

Publisher类:

返回值 方法 作用
  __init__(self, name, data_class, queue_size=None) 构造函数
  publish(self, msg) 发布消息
str unregister(self) 停止发布
pub = rospy.Publisher('topic_name',msg_type,queue_size = None) #若queue_size是 None 则为同步通信方式,若为整数则为异步通信方式
pub.publish(msg)    #发布消息
pub.unregister()    #停止发布

 

Subscriber类:

返回值 方法 作用
  __init__(self, name, data_class, call_back=None, queue_size=None) 构造函数
  unregister(self, msg) 停止订阅

 rospy-Service相关

函数:

返回值 方法 作用
  wait_for_service(service, timeout=None) 阻塞直到服务可用

Service类(server):

返回值 方法 作用
  __init__(self, name, service_class, handler) 构造函数,handler为处理函数,service_class为srv类型
  shutdown(self) 关闭服务的server

关于回调函数handle,在rospy中传入参数是request 返回参数是response:

def handler(req):
....
return res

而在roscpp中传入参数是request和response,返回参数是一个布尔值:

bool handler(req,res)
{    
    ...
    return bool;
}

 

ServiceProxy类(client):

返回值 方法 作用
  __init__(self, name, service_class) 构造函数,创建client
  __call__(self, args, *kwds) 发起请求
  call(self, args, *kwds) 同上
  close(self) 关闭服务的client

 

 rospy-Param相关

函数:

返回值 方法 作用
XmlRpcLegalValue get_param(param_name, default=_unspecified) 获取参数的值
[str] get_param_names() 获取参数的名称
  set_param(param_name, param_value) 设置参数的值
  delete_param(param_name) 删除参数
bool has_param(param_name) 参数是否存在于参数服务器上
str search_param() 搜索参数

rospy-Time相关

函数:

返回值 方法 作用
Time get_rostime() 获取当前时刻的Time对象
float get_time() 返回当前时间,单位秒
  sleep(duration) 执行挂起

Time类:(时刻)

返回值 方法 作用
  __init__(self, secs=0, nsecs=0) 构造函数
Time now() 静态方法 返回当前时刻的Time对象

Duration类:(一段时间)

返回值 方法 作用
  __init__(self, secs=0, nsecs=0) 构造函数

 注:Time+Time=Duration     Time+Duration=Time     Duration+Duration=Duration     Duration-Duration=Duration      Time+Time无意义  

Rate类:

返回值 方法 作用
  __init__(self,frequency) 构造函数
  sleep(self) 挂起 考虑上一次的rate.sleep()的时间
Time remaining(self) 成员函数 剩余sleep时间

 

Topic_demo 

(https://github.com/DroidAITech/ROS-Academy-for-Beginners/tree/master/topic_demo)

功能描述和步骤和roscpp的Topic_demo相同

gps.msg文件在经过catkin_make后,会在以下路径生成py文件

~/catkin_ws/devel/lib/python2.7/dis-pacakges/topic_demo/msg/__init__.py

引用格式如下:

from topic_demo.msg import gps

pylistener.py

#!/usr/bin/env python
#coding=utf-8
import rospy
import math
#导入mgs
from topic_demo.msg import gps

#回调函数输入的应该是msg
def callback(gps):
    distance = math.sqrt(math.pow(gps.x, 2)+math.pow(gps.y, 2)) 
    rospy.loginfo('Listener: GPS: distance=%f, state=%s', distance, gps.state)

def listener():
    rospy.init_node('pylistener', anonymous=True)
    #Subscriber函数第一个参数是topic的名称,第二个参数是接受的数据类型 第三个参数是回调函数的名称
    rospy.Subscriber('gps_info', gps, callback)
    rospy.spin()

if __name__ == '__main__':
    listener()

pytalker.py

#!/usr/bin/env python
#coding=utf-8
import rospy
#导入自定义的数据类型
from topic_demo.msg import gps

def talker():
    #Publisher 函数第一个参数是话题名称,第二个参数 数据类型,现在就是我们定义的msg 最后一个是缓冲区的大小
    #queue_size: None(不建议)  #这将设置为阻塞式同步收发模式!
    #queue_size: 0(不建议)#这将设置为无限缓冲区模式,很危险!
    #queue_size: 10 or more  #一般情况下,设为10 。queue_size太大了会导致数据延迟不同步。
    pub = rospy.Publisher('gps_info', gps , queue_size=10)
    rospy.init_node('pytalker', anonymous=True)
    #更新频率是1hz
    rate = rospy.Rate(1) 
    x=1.0
    y=2.0
    state='working'
    while not rospy.is_shutdown():
        #计算距离
        rospy.loginfo('Talker: GPS: x=%f ,y= %f',x,y)
        pub.publish(gps(state,x,y))
        x=1.03*x
        y=1.01*y
        rate.sleep()

if __name__ == '__main__':
    talker()

CMakeList.txt 和 package.xml 同前

 

service_demo

(https://github.com/DroidAITech/ROS-Academy-for-Beginners/tree/master/service_demo)

功能描述和步骤同前。

Greeting.srv文件在经过catkin_make后,会在以下路径生成py文件

~/catkin_ws/devel/lib/python2.7/dis-pacakges/service_demo/srv/__init__.py

引用格式如下:

from service_demo.srv import *  #import的有 Greeting GreetingResponse GreetingRequest

server_demo.py

#!/usr/bin/env python
#coding=utf-8
import rospy
from service_demo.srv import *

def server_srv():
    # 初始化节点,命名为 "greetings_server"
    rospy.init_node("greetings_server")
    # 定义service的server端,service名称为"greetings", service类型为Greeting
    # 收到的request请求信息将作为参数传递给handle_function进行处理
    s = rospy.Service("greetings", Greeting, handle_function)
    rospy.loginfo("Ready to handle the request:")
    # 阻塞程序结束
    rospy.spin()

def handle_function(req):
    # 注意我们是如何调用request请求内容的,是将其认为是一个对象的属性,在我们定义
    # 的Service_demo类型的service中,request部分的内容包含两个变量,一个是字符串类型的name,另外一个是整数类型的age
    rospy.loginfo( 'Request from %s with age %d', req.name, req.age)
    # 返回一个Service_demo.Response实例化对象,其实就是返回一个response的对象,其包含的内容为我们在Service_demo.srv中定义的
    # response部分的内容,我们定义了一个string类型的变量feedback,因此,此处实例化时传入字符串即可
    return GreetingResponse("Hi %s. I' server!"%req.name)

# 如果单独运行此文件,则将上面定义的server_srv作为主函数运行
if __name__=="__main__":
    server_srv()

 client_demo.py

#!/usr/bin/env python
# coding:utf-8
import rospy
from service_demo.srv import *

def client_srv():
    rospy.init_node('greetings_client')
    # 等待有可用的服务 "greetings"
    rospy.wait_for_service("greetings")
    try:
        # 定义service客户端,service名称为“greetings”,service类型为Greeting
        greetings_client = rospy.ServiceProxy("greetings",Greeting)

        # 向server端发送请求,发送的request内容为name和age,其值分别为"HAN", 20
        # 此处发送的request内容与srv文件中定义的request部分的属性是一致的
        #resp = greetings_client("HAN",20)
        resp = greetings_client.call("HAN",20)
        rospy.loginfo("Message From server:%s"%resp.feedback)
    except rospy.ServiceException, e:
        rospy.logwarn("Service call failed: %s"%e)

# 如果单独运行此文件,则将上面函数client_srv()作为主函数运行
if __name__=="__main__":
    client_srv()

 

你可能感兴趣的:(ROS学习)