ROS学习笔记十四：topic_demo(rospy)

topic_demo

功能描述：两个node，一个发布模拟的GPS消息（格式为自定义，包括坐标和工作状态），另一个接收并处理该信息（计算到原点的距离）

步骤：
1.package
2.msg
3.talker.cpp
4.listener.cpp
5.CMakeList.txt&package.xml

3.pylistener.py

import rospy
import math
from topic_demo.msg import gps

def callback(gps):
	distance = math.sqrt(math.pow(gps.x,2)+math.pow(gps.y,2))
	rospy.loginfo