31 {
32 std::vector<std::string> expect_entry = { "t", "p_x", "p_y", "p_z" };
33
35 ReadCsv(&csv_data, file_path);
36
37 unsigned long number_of_datapoints = csv_data["t"].size();
38 data_out->resize(number_of_datapoints);
39
40 for (size_t k = 0; k < number_of_datapoints; k++)
41 {
42 Time time = csv_data["t"][k] + time_offset;
43 Eigen::Vector3d position(csv_data["p_x"][k], csv_data["p_y"][k], csv_data["p_z"][k]);
44
45 BufferDataType data;
46 data.set_measurement(std::make_shared<PositionMeasurementType>(position));
47
48 BufferEntryType current_entry(time, data, sensor);
49 data_out->at(k) = current_entry;
50 }
51 }
std::map< std::string, std::vector< double > > CsvDataType
Definition read_csv.h:26