ros 写node 存储数据到txt_ROS学习 Python读写文本文件

Myth丶恋晨 2023-01-10 05:16 101阅读 0赞

importrandomimportrospyimportactionlibimportwaypoint\_touring.utils as utilsimportmove\_base\_msgs.msg as move\_base\_msgsimportvisualization\_msgs.msg as viz\_msgsclassTourMachine(object):def \_\_init\_\_(self, filename, random\_visits=False, repeat=False):

self.\_waypoints=utils.get\_waypoints(filename)

action\_name= 'move\_base'self.\_ac\_move\_base=actionlib.SimpleActionClient(action\_name, move\_base\_msgs.MoveBaseAction)

rospy.loginfo('Wait for %s server' %action\_name)

self.\_ac\_move\_base.wait\_for\_server

self.\_counter=0

self.\_repeat=repeat

self.\_random\_visits=random\_visitsifself.\_random\_visits:

random.shuffle(self.\_waypoints)

self.\_pub\_viz\_marker= rospy.Publisher('viz\_waypoints', viz\_msgs.MarkerArray, queue\_size=1, latch=True)

self.\_viz\_markers=utils.create\_viz\_markers(self.\_waypoints)defmove\_to\_next(self):

p=self.\_get\_next\_destination()if notp:

rospy.loginfo("Finishing Tour")returnTrue

goal=utils.create\_move\_base\_goal(p)

rospy.loginfo("Move to %s" % p\['name'\])

self.\_ac\_move\_base.send\_goal(goal)

self.\_ac\_move\_base.wait\_for\_result()

result=self.\_ac\_move\_base.get\_result()

rospy.loginfo("Result : %s" %result)returnFalsedef\_get\_next\_destination(self):if self.\_counter ==len(self.\_waypoints):ifself.\_repeat:

self.\_counter=0ifself.\_random\_visits:

random.shuffle(self.\_waypoints)else:

next\_destination=None

next\_destination=self.\_waypoints\[self.\_counter\]

self.\_counter= self.\_counter + 1

returnnext\_destinationdefspin(self):

rospy.sleep(1.0)

self.\_pub\_viz\_marker.publish(self.\_viz\_markers)

finished=Falsewhile not rospy.is\_shutdown() and notfinished:

finished=self.move\_to\_next()

rospy.sleep(2.0)if \_\_name\_\_ == '\_\_main\_\_':

rospy.init\_node('tour')

filename= rospy.get\_param('~filename')

random\_visits= rospy.get\_param('~random', False)

repeat= rospy.get\_param('~repeat', False)

m=TourMachine(filename, random\_visits, repeat)

rospy.loginfo('Initialized')

m.spin()

rospy.loginfo('Bye Bye')

发表评论取消回复

表情：

评论列表（有 0 条评论，101人围观）

还没有评论，来说两句吧...

相关阅读

相关 Python读写txt文本文件

[Python读写txt文本文件][Python_txt] 一、文件的打开和创建 <table> <tbody> <tr> <td> <p>1</p>

布满荆棘的人生/ 2023年10月18日 17:11/ 0 赞/ 148 阅读

相关 Python-数据读写

os模块系统内置模块不需要install import os print(os.name) 输出正在使用平台 window-nt

痛定思痛。/ 2023年10月11日 10:05/ 0 赞/ 38 阅读

相关 Qt：读写文本文件

新建Qt控制台应用，修改main.cpp 1、QFile读写文件 include <QCoreApplication> include <QFile>

不念不忘少年蓝@/ 2023年01月12日 11:47/ 0 赞/ 198 阅读

相关 ros 写node 存储数据到txt_ROS学习 Python读写文本文件

importrandomimportrospyimportactionlibimportwaypoint\_touring.utils as utilsimportmove\_

Myth丶恋晨/ 2023年01月10日 05:16/ 0 赞/ 102 阅读

相关 JavaScript读写文本文件

In this tutorial, I will tell you about how you can read and write to text file using Ja

矫情吗；*/ 2022年12月07日 12:55/ 0 赞/ 265 阅读

相关 Qt 文本文件读写

1.文本文件文本文件是指以纯文本格式存储的文件，例如用 [Qt][] Creator 编写的 [C++][C] 程序的头文件（上文件）和源程序文件（.cpp 文件）。H

一时失言乱红尘/ 2022年11月03日 00:42/ 0 赞/ 238 阅读

相关 QT学习之文本文件读写

上一章我们介绍了有关二进制文件的读写。二进制文件比较小巧，却不是人可读的格式。而文本文件是一种人可读的文件。为了操作这种文件，我们需要使用QTextStream类。QTextS

女爷i/ 2022年08月05日 07:37/ 0 赞/ 207 阅读

相关 C# 文本文件的读写

![watermark_type_ZmFuZ3poZW5naGVpdGk_shadow_10_text_aHR0cHM6Ly9ibG9nLmNzZG4ubmV0L2xlbmd5

小鱼儿/ 2021年12月21日 06:05/ 0 赞/ 294 阅读

相关 c++ 读写文本文件

1 include <iostream> 2 include <fstream> // 读写文件的头文件 3 include <stri

水深无声/ 2021年12月09日 01:37/ 0 赞/ 325 阅读

相关 VB读写文本文件

> 把字符串保存到.txt文本文件。 [读取文本文件（或读取某一行）参考这篇][Link 1] 1、代码 '-----------------------

深藏阁楼爱情的钟/ 2021年08月19日 20:34/ 0 赞/ 497 阅读