29 {
30
31 out_msg->mutable_header()->set_timestamp_sec(
32 scan_msg->basetime() / 1000000000.0);
33 out_msg->mutable_header()->set_module_name(
34 scan_msg->header().module_name());
35 out_msg->mutable_header()->set_frame_id(scan_msg->header().frame_id());
36 out_msg->set_height(1);
37 out_msg->set_measurement_time(scan_msg->basetime() / 1000000000.0);
38 out_msg->mutable_header()->set_sequence_num(
39 scan_msg->header().sequence_num());
40 gps_base_usec_ = scan_msg->basetime();
41
42 const unsigned char* difop_ptr
43 = (const unsigned char*)scan_msg->difop_pkts(0).data().c_str();
44
45 two_bytes angle_1, angle_2, angle_3, angle_4;
46 angle_1.bytes[0] = difop_ptr[243];
47 angle_1.bytes[1] = difop_ptr[242];
49
50 angle_2.bytes[0] = difop_ptr[245];
51 angle_2.bytes[1] = difop_ptr[244];
53
54 angle_3.bytes[0] = difop_ptr[247];
55 angle_3.bytes[1] = difop_ptr[246];
57
58 angle_4.bytes[0] = difop_ptr[249];
59 angle_4.bytes[1] = difop_ptr[248];
61
62 packets_size = scan_msg->firing_pkts_size();
63
64 for (size_t i = 0; i < packets_size; ++i) {
65 Unpack(static_cast<int>(i),
66 scan_msg->firing_pkts(static_cast<int>(i)),
67 out_msg);
70 }
71
72 AINFO <<
"packets_size :" << packets_size;
73 if (out_msg->point().empty()) {
74
76 }
77
78
79 out_msg->set_width(out_msg->point_size());
80}