您现在的位置是:首页 >技术教程 >Ouster激光雷达使用PTP时间同步网站首页技术教程

Ouster激光雷达使用PTP时间同步

晓晨的博客 2024-06-17 10:14:33
简介Ouster激光雷达使用PTP时间同步

IEEE1588(the Precision Time Protocol 简称为 PTP )全称是“网络测量和控制系统的精密时钟同步协议标准”,可以使用ubuntu中的网卡作为时间的master也可以外接一个精准的时钟,来实现传感器的时间同步。

Ouster官方参考链接

+-------------------------------------+
| Ubuntu 18.04 System                 |
| * 2x Intel i210 Ethernet Interfaces |
| * Linux PTP service                 |
|                                     |
|      eno1                 eno2      |
+-------+---------------------+-------+
        |                     |
+-------+-------+    +--------+------+
| Trimble GM100 |    |               + +
|  GPS -> PTP   |    |  Ouster OS1   | |
|  grandmaster  |    |               | |
|  (optional)   |    |               | |
+---------------+    +---------------- |
                      +--------------- +

本篇博客主要介绍单独使用一个NUC连接Ouster OS1-128激光雷达来实现PTP时间同步。

准备工作

安装linuxptp,chrony,ethtool等工具

sudo apt update

sudo apt install linuxptp chrony ethtool

确保以太网接口支持PTP功能

# 查看网络接口
ifconfig
# 查看是否有PTP功能
sudo ethtool -T YOUR_INTERFACE

出现类似如下结果,则证明支持PTP功能(PTP Hardware Clock: 0)

Time stamping parameters for eno1:
Capabilities:
        hardware-transmit     (SOF_TIMESTAMPING_TX_HARDWARE)
        software-transmit     (SOF_TIMESTAMPING_TX_SOFTWARE)
        hardware-receive      (SOF_TIMESTAMPING_RX_HARDWARE)
        software-receive      (SOF_TIMESTAMPING_RX_SOFTWARE)
        software-system-clock (SOF_TIMESTAMPING_SOFTWARE)
        hardware-raw-clock    (SOF_TIMESTAMPING_RAW_HARDWARE)
PTP Hardware Clock: 0
Hardware Transmit Timestamp Modes:
        off                   (HWTSTAMP_TX_OFF)
        on                    (HWTSTAMP_TX_ON)
Hardware Receive Filter Modes:
        none                  (HWTSTAMP_FILTER_NONE)
        all                   (HWTSTAMP_FILTER_ALL)

出现下述结果,则证明不支持:(PTP Hardware Clock: none)

Time stamping parameters for enxf8e43bb4ab3d:
Capabilities:
	software-transmit     (SOF_TIMESTAMPING_TX_SOFTWARE)
	software-receive      (SOF_TIMESTAMPING_RX_SOFTWARE)
	software-system-clock (SOF_TIMESTAMPING_SOFTWARE)
PTP Hardware Clock: none
Hardware Transmit Timestamp Modes: none
Hardware Receive Filter Modes: none

若支持PTP功能,则继续下述操作,否则需要外接一个外部的钟。

PTP4l

  • 修改/etc/linuxptp/ptp4l.conf 文件中内容。
clockClass 128
boundary_clock_jbod 1
[YOUR_INTERFACE] <- (这个放到文档中的最后,如我的为[enp86s0]
  • 创建一个文件夹
sudo mkdir -p /etc/systemd/system/ptp4l.service.d
  • 在文件夹中新建下述文件,并添加内容
sudo touch /etc/systemd/system/ptp4l.service.d/override.conf
sudo gedit /etc/systemd/system/ptp4l.service.d/override.conf
[Service]
ExecStart=
ExecStart=/usr/sbin/ptp4l -f /etc/linuxptp/ptp4l.conf

phc2sys

  • 创建一个文件夹
sudo mkdir -p /etc/systemd/system/phc2sys.service.d
  • 在文件夹中新建下述文件,并添加内容
sudo touch  /etc/systemd/system/phc2sys.service.d/override.conf

sudo gedit /etc/systemd/system/phc2sys.service.d/override.conf
[Service]
ExecStart=
ExecStart=/usr/sbin/phc2sys -w -s CLOCK_REALTIME -c YOUR_INTERFACE(你的以太网接口名字)

修改此 /etc/systemd/system/phc2shm.service文件中的内容:

[Unit]
Description=Synchronize PTP hardware clock (PHC) to NTP SHM
Documentation=man:phc2sys
After=ntpdate.service
Requires=ptp4l.service
After=ptp4l.service
[Service]
Type=simple
ExecStart=/usr/sbin/phc2sys -s YOUR_INTERFACE -E ntpshm -w 
[Install]
WantedBy=multi-user.target

注:YOUR_INTERFACE为你的以太网接口名字

启动各项服务

sudo systemctl daemon-reload
sudo systemctl restart ptp4l
sudo systemctl restart phc2sys
sudo systemctl restart phc2shm

启动ouster驱动

修改ouster驱动中的Launch文件中内容timestamp_mode (string) - Method used to timestamp measurements [TIME_FROM_INTERNAL_OSC, TIME_FROM_SYNC_PULSE_IN, TIME_FROM_PTP_1588]为TIME_FROM_PTP_1588。

  • 启动ouster
source devel/setup.bash
roslaunch ouster_ros ouster_XXX.launch

接受对应的topic 并查看时间戳

Ouster_IMU: 1769 1683895566.722931
Ouster_Lidar: 177 1683895566.733269
Ouster_IMU: 1770 1683895566.737509
Ouster_IMU: 1771 1683895566.742845
Ouster_IMU: 1772 1683895566.752959
Ouster_IMU: 1773 1683895566.763221
Ouster_IMU: 1774 1683895566.772937
Ouster_IMU: 1775 1683895566.783624

注:需要读者自己写一个小程序

风语者!平时喜欢研究各种技术,目前在从事后端开发工作,热爱生活、热爱工作。