C++读取txt文件,并利用ROS将其作为数据流输出

#include "ros/ros.h"
#include "std_msgs/String.h"
#include <sstream>
#include <iostream>
#include <vector>
#include <string>
#include <fstream>
using namespace std;

void LoadImages(const string &trajectory, vector<string> &position_x)
{
    ifstream fTimes;
    // 数据流读取文件
    fTimes.open(trajectory.c_str());
    position_x.reserve(5000);
    //position_y.reserve(5000);
    //position_z.reserve(5000);
    //vTimeStamps.reserve(5000);
    while(!fTimes.eof())
    {
        string s;
        getline(fTimes,s);
        if(!s.empty())
        {
            //stringstream ss;
            //ss << s;
	        position_x.push_back(s);
            //double t;
            //ss >> t;
            //vTimeStamps.push_back(t/1e9);

        }
    }
}


int main(int argc, char **argv){
    if(argc != 2){
        cerr << endl << "Usage: wenjian" << endl;
    }
    vector<string> vposition;

    LoadImages(string(argv[1]),vposition);

    ros::init(argc,argv,"publish"); //初始化节点
    ros::NodeHandle n;
    ros::Publisher chatter_pub = n.advertise<std_msgs::String>("message",1000); //定义发送端
    ros::Rate loop_rate(10); //频率
    vector<string>::iterator i = vposition.begin();
    //auto i = vposition.begin();
    while (ros::ok()){
        if (i == vposition.end()){
            break;
        }
	std_msgs::String msg;
	std::stringstream ss;
        string s_out = *i;
	ss << s_out;
	msg.data = ss.str(); // 字符串message
	chatter_pub.publish(msg);
        i = i + 1;
	ros::spinOnce();
	loop_rate.sleep();
	}
    return 0;
}

 

  • 1
    点赞
  • 18
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值