vins_datapath = str(sys.argv[1])
output_path = os.path.dirname(vins_datapath)
lidar_datapath = str(sys.argv[2])
fin = open(vins_datapath,'r')
vins_data_x = []
vins_data_y = []
lidar_data_x = []
lidar_data_y = []
for line in fin.readlines():
posi = []
s = line[:]
s = s[s.index(' ')+1:]
for i in range(3):
posi.append ( float( s[0:s.index(' ')]) )
s = s[s.index(' ')+1:]
print posi
vins_data_x.append(posi[0])
vins_data_y.append(posi[1])
fin.close()
输入
1501063065.448634863 -3.9585683e-07 7.4430352e-07 -1.5125672e-06 -0.70791769 0.0047230759 0.014934978 0.70612122
1501063065.481942892 -0.018695537 -0.01811403 -0.012644703 -0.70745779 0.0048642962 0.014681713 0.70658635
输出
-3.9585683e-07 7.4430352e-07 -1.5125672e-06
-0.018695537 -0.01811403 -0.012644703