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(