72 {
73 ins_status_.mutable_header()->set_timestamp_sec(
75 gnss_status_.mutable_header()->set_timestamp_sec(
77
78 gnssstatus_writer_ = node_->CreateWriter<GnssStatus>(FLAGS_gnss_status_topic);
79 insstatus_writer_ = node_->CreateWriter<
InsStatus>(FLAGS_ins_status_topic);
80 gnssbestpose_writer_ =
81 node_->CreateWriter<GnssBestPose>(FLAGS_gnss_best_pose_topic);
82 corrimu_writer_ = node_->CreateWriter<CorrectedImu>(FLAGS_imu_topic);
83 insstat_writer_ = node_->CreateWriter<InsStat>(FLAGS_ins_stat_topic);
84 gnssephemeris_writer_ =
85 node_->CreateWriter<GnssEphemeris>(FLAGS_gnss_rtk_eph_topic);
86 epochobservation_writer_ =
87 node_->CreateWriter<EpochObservation>(FLAGS_gnss_rtk_obs_topic);
88 heading_writer_ = node_->CreateWriter<Heading>(FLAGS_heading_topic);
89 rawimu_writer_ = node_->CreateWriter<Imu>(FLAGS_raw_imu_topic);
90 gps_writer_ = node_->CreateWriter<Gps>(FLAGS_gps_topic);
91
92 common::util::FillHeader("gnss", &ins_status_);
93 insstatus_writer_->Write(ins_status_);
94 common::util::FillHeader("gnss", &gnss_status_);
95 gnssstatus_writer_->Write(gnss_status_);
96
99 if (!data_parser_) {
100 AFATAL <<
"Failed to create data parser.";
101 return false;
102 }
103
104 init_flag_ = true;
105 return true;
106}
static Time Now()
get the current time.
static Parser * CreateParser(const config::Config &config)