1. pcap解析工具

Libpcap是Packet Capture Libray的英文缩写，即数据包捕获函数库。提供的接口函数实现和封装了与数据包截获有关的过程。

安装方法：sudo apt install libpcap-dev

2. pcap header中的时间戳解析

Libpcap中的packet的header结构如下：

struct timeval
{__time_t tv_sec;       /* Seconds.  */__suseconds_t tv_usec;   /* Microseconds.  */
};struct pcap_pkthdr {struct timeval ts;    /* time stamp */bpf_u_int32 caplen; /* length of portion present */bpf_u_int32 len; /* length this packet (off wire) */
};

其中，ts即为接收时间戳。利用Libpcap库中的pcap_next_ex()函数可从packet中解析其header数据

int InputPCAP::getPacket(velodyne_msgs::VelodynePacket *pkt, const double time_offset){struct pcap_pkthdr *header;const u_char *pkt_data;while (true){int res;if ((res = pcap_next_ex(pcap_, &header, &pkt_data)) >= 0){// Skip packets not for the correct port and from the// selected IP address.if (0 == pcap_offline_filter(&pcap_packet_filter_,header, pkt_data))continue;// Keep the reader from blowing through the file.if (read_fast_ == false)packet_rate_.sleep();memcpy(&pkt->data[0], pkt_data+42, packet_size);if (!gps_time_) {if (!pcap_time_) {pkt->stamp = ros::Time::now(); // time_offset not considered here, as no synchronization required} else {pkt->stamp = ros::Time(header->ts.tv_sec, header->ts.tv_usec * 1000); // }} else {// time for each packet is a 4 byte uint located starting at offset 1200 in// the data packetpkt->stamp = rosTimeFromGpsTimestamp(&(pkt->data[1200]), header);}empty_ = false;return 0;                   // success}if (empty_)                 // no data in file?{ROS_WARN("Error %d reading Velodyne packet: %s", res, pcap_geterr(pcap_));return -1;}if (read_once_){ROS_INFO("end of file reached -- done reading.");return -1;}if (repeat_delay_ > 0.0){ROS_INFO("end of file reached -- delaying %.3f seconds.",repeat_delay_);usleep(rint(repeat_delay_ * 1000000.0));}ROS_DEBUG("replaying Velodyne dump file");// I can't figure out how to rewind the file, because it// starts with some kind of header.  So, close the file// and reopen it with pcap.pcap_close(pcap_);pcap_ = pcap_open_offline(filename_.c_str(), errbuf_);empty_ = true;              // maybe the file disappeared?} // loop back and try again}

3. pcap data中gps时间格式

velodyne的数据包格式中gps timestamp数据存放于[1200～1203]，共4个字节。表示一小时内的毫秒数。

4. gps时间戳合成

第一步从packet的status data中获取gps timestamp；

第二步提取header中的时间戳，并将精度保留到小时；

第三步将第二步结果与gps timestamp结合，得到时间戳；

第四步对齐时间戳。

ros::Time resolveHourAmbiguity(const ros::Time &stamp, const ros::Time &nominal_stamp) {const int HALFHOUR_TO_SEC = 1800;ros::Time retval = stamp;if (nominal_stamp.sec > stamp.sec) {if (nominal_stamp.sec - stamp.sec > HALFHOUR_TO_SEC) {retval.sec = retval.sec + 2*HALFHOUR_TO_SEC;}} else if (stamp.sec - nominal_stamp.sec > HALFHOUR_TO_SEC) {retval.sec = retval.sec - 2*HALFHOUR_TO_SEC;}return retval;
}ros::Time rosTimeFromGpsTimestamp(const uint8_t * const data, const struct pcap_pkthdr *header = NULL) {const int HOUR_TO_SEC = 3600;// time for each packet is a 4 byte uint// It is the number of microseconds from the top of the houruint32_t usecs = (uint32_t) ( ((uint32_t) data[3]) << 24 |((uint32_t) data[2] ) << 16 |((uint32_t) data[1] ) << 8 |((uint32_t) data[0] ));ROS_INFO("gpstime: %d", usecs);ros::Time time_nom = ros::Time();// if header is NULL, assume real time operationif (!header) {time_nom = ros::Time::now(); // use this to recover the hour} else {ROS_INFO("header sec: %ld, usec: %ld", header->ts.tv_sec, header->ts.tv_usec);time_nom = ros::Time(header->ts.tv_sec, header->ts.tv_usec * 1000);}uint32_t cur_hour = time_nom.sec / HOUR_TO_SEC;ros::Time stamp = ros::Time((cur_hour * HOUR_TO_SEC) + (usecs / 1000000),(usecs % 1000000) * 1000);ROS_INFO("before stamp sec: %d, nsec: %d", stamp.sec, stamp.nsec);stamp = resolveHourAmbiguity(stamp, time_nom);ROS_INFO("after stamp sec: %d, nsec: %d", stamp.sec, stamp.nsec);return stamp;
}

Velodyne 32E pcap包GPS时间戳解析相关推荐

C++实现pcap包解析，并提取指定特征帧
目录前言 1.流量结构 2.类C结构 3.指令类型二.代码示例 1.引入头文件 2.设置全局变量 3.函数 1.高低字节交换 2. 十六字节拼接 3.将木马检测结果写入csv文件 4.获取文件夹下 ...
python解析pcap包,python-用scapy读取PCAP文件
我有大约10GB的pcap数据和IPv6流量,用于分析存储在IPv6头和其他扩展头中的信息.为此,我决定使用Scapy框架.我尝试了rdpcap函数,但是对于如此大的文件,不建议这样做.它试图将所有文 ...
SLAM精度评估常见问题——GPS时间戳与bag包时间戳如何对齐
在使用evo进行精度评估时,由于evo是通过时间戳来进行配准和比较的,为了使结果更准确,需要将GPS与bag包的时间戳进行转换对齐在这里更方便的方法是转换GPS时间戳到bag包首先查看GPS文件 ...
python解析pcap包已text格式输出_python分析pcap包
前两天需要分析一个pcap包,写了一段python脚本,将每个包的基本信息(源/目的MAC.源/目的IP.源/目的端口)提取出来. 在实现过程中为了省事用了dpkt开发包,不过只用了几个简单的函数,具 ...
pcap文件格式及文件解析
pcap文件格式及文件解析第一部分:PCAP包文件格式一基本格式: 文件头数据包头数据报数据包头数据报...... 二.文件头: 文件头结构体 sturct pcap_file_header ...
linux 发包命令,LINUX tcpreplay命令-将PCAP包重新发送，用于性能或者功能测试
将PCAP包重新发送,用于性能或者功能测试补充说明简单的说, tcpreplay 是一种pcap包的重放工具,它可以将用ethreal.wireshark工具抓下来的包原样或经过任意修改后重放回去 ...
google Guava包的ListenableFuture解析
原文地址译者:罗立树校对:方腾飞并发编程是一个难题,但是一个强大而简单的抽象可以显著的简化并发的编写.出于这样的考虑,Guava 定义了 ListenableFuture接口并继承了JDK ...
学习笔记之rpm程序包管理功能解析
Rpm包管理功能全解软件包管理的功能:将编译好的程序的各组成文件打包成一个或几个程序包文件,为了方便的实现程序包的安装.升级.卸载.查询.校验.数据库维护. 下面我们来看看RPM包管理的解析 Rpm ...
android gps磁偏角,GPS数据格式解析
GPS数据格式解析简介 GPS发送数据以行为单位,数据格式如下: $信息类型,x,x,x,x,x,x,x,x,x,x,x,x,x 每行以字符"$"开头,以为结尾,CR-Carri ...

Velodyne 32E pcap包GPS时间戳解析

1. pcap解析工具

2. pcap header中的时间戳解析

3. pcap data中gps时间格式

4. gps时间戳合成

Velodyne 32E pcap包GPS时间戳解析相关推荐

最新文章

热门文章