提交 04d7cfc8 编写于 作者: Y Yifei Jiang 提交者: Qi Luo

tool: minor change to mobileye viewer and planning lite (#966)

上级 af9474d9
...@@ -31,6 +31,7 @@ from subplot_s_theta import SubplotSTheta ...@@ -31,6 +31,7 @@ from subplot_s_theta import SubplotSTheta
from subplot_s_time import SubplotSTime from subplot_s_time import SubplotSTime
from modules.localization.proto import localization_pb2 from modules.localization.proto import localization_pb2
PLANNING_TOPIC = '/apollo/planning_lite'
mobileye = MobileyeData() mobileye = MobileyeData()
localization = LocalizationData() localization = LocalizationData()
planning = PlanningData() planning = PlanningData()
...@@ -60,7 +61,7 @@ def add_listener(): ...@@ -60,7 +61,7 @@ def add_listener():
rospy.Subscriber('/apollo/sensor/mobileye', rospy.Subscriber('/apollo/sensor/mobileye',
mobileye_pb2.Mobileye, mobileye_pb2.Mobileye,
mobileye_callback) mobileye_callback)
rospy.Subscriber('/apollo/planning_lite', rospy.Subscriber(PLANNING_TOPIC,
planning_pb2.ADCTrajectory, planning_pb2.ADCTrajectory,
planning_callback) planning_callback)
rospy.Subscriber('/apollo/localization/pose', rospy.Subscriber('/apollo/localization/pose',
......
...@@ -29,6 +29,8 @@ from modules.localization.proto import localization_pb2 ...@@ -29,6 +29,8 @@ from modules.localization.proto import localization_pb2
from modules.canbus.proto import chassis_pb2 from modules.canbus.proto import chassis_pb2
planning_pub = None planning_pub = None
PUB_NODE_NAME = "planning_lite"
PUB_TOPIC = "/apollo/" + PUB_NODE_NAME
f = open("benchmark.txt","w") f = open("benchmark.txt","w")
SPEED = 0 #m/s SPEED = 0 #m/s
CRUISE_SPEED = 10 #m/s CRUISE_SPEED = 10 #m/s
...@@ -138,7 +140,7 @@ def mobileye_callback(mobileye_pb): ...@@ -138,7 +140,7 @@ def mobileye_callback(mobileye_pb):
def add_listener(): def add_listener():
global planning_pub global planning_pub
rospy.init_node('planning_lite', anonymous=True) rospy.init_node(PUB_NODE_NAME, anonymous=True)
rospy.Subscriber('/apollo/sensor/mobileye', rospy.Subscriber('/apollo/sensor/mobileye',
mobileye_pb2.Mobileye, mobileye_pb2.Mobileye,
mobileye_callback) mobileye_callback)
...@@ -150,7 +152,7 @@ def add_listener(): ...@@ -150,7 +152,7 @@ def add_listener():
chassis_callback) chassis_callback)
planning_pub = rospy.Publisher( planning_pub = rospy.Publisher(
'/apollo/planning_lite', planning_pb2.ADCTrajectory, queue_size=1) PUB_TOPIC, planning_pb2.ADCTrajectory, queue_size=1)
def update(frame_number): def update(frame_number):
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册