On Thu, 29 Oct 2020 21:09:31 +0200 Grygorii Strashko wrote:
> The timestamping tool is supporting now only PTPv1 (IEEE-1588 2002) while
> modern HW often supports also/only PTPv2.
>
> Hence timestamping tool is still useful for sanity testing of PTP drivers
> HW timestamping capabilities it's reasonable to upstate it to support
> PTPv2. This patch adds corresponding support which can be enabled by using
> new parameter "PTPV2".
>
> Signed-off-by: Grygorii Strashko <grygorii.strashko@xxxxxx>
CC: Richard
> diff --git a/tools/testing/selftests/net/timestamping.c b/tools/testing/selftests/net/timestamping.c
> index f4bb4fef0f39..21091be70688 100644
> --- a/tools/testing/selftests/net/timestamping.c
> +++ b/tools/testing/selftests/net/timestamping.c
> @@ -59,7 +59,8 @@ static void usage(const char *error)
> " SOF_TIMESTAMPING_SOFTWARE - request reporting of software time stamps\n"
> " SOF_TIMESTAMPING_RAW_HARDWARE - request reporting of raw HW time stamps\n"
> " SIOCGSTAMP - check last socket time stamp\n"
> - " SIOCGSTAMPNS - more accurate socket time stamp\n");
> + " SIOCGSTAMPNS - more accurate socket time stamp\n"
> + " PTPV2 - use PTPv2 messages\n");
> exit(1);
> }
>
> @@ -115,13 +116,28 @@ static const unsigned char sync[] = {
> 0x00, 0x00, 0x00, 0x00
> };
>
> -static void sendpacket(int sock, struct sockaddr *addr, socklen_t addr_len)
> +static const unsigned char sync_v2[] = {
> + 0x00, 0x02, 0x00, 0x2C,
> + 0x00, 0x00, 0x02, 0x00,
> + 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0xFF,
> + 0xFE, 0x00, 0x00, 0x00,
> + 0x00, 0x01, 0x00, 0x01,
> + 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00,
> +};
> +
> +static void sendpacket(int sock, struct sockaddr *addr, socklen_t addr_len, int ptpv2)
> {
> + size_t sync_len = ptpv2 ? sizeof(sync_v2) : sizeof(sync);
> + const void *sync_p = ptpv2 ? sync_v2 : sync;
> struct timeval now;
> int res;
>
> - res = sendto(sock, sync, sizeof(sync), 0,
> - addr, addr_len);
> + res = sendto(sock, sync_p, sync_len, 0, addr, addr_len);
> gettimeofday(&now, 0);
> if (res < 0)
> printf("%s: %s\n", "send", strerror(errno));
> @@ -134,9 +150,11 @@ static void sendpacket(int sock, struct sockaddr *addr, socklen_t addr_len)
> static void printpacket(struct msghdr *msg, int res,
> char *data,
> int sock, int recvmsg_flags,
> - int siocgstamp, int siocgstampns)
> + int siocgstamp, int siocgstampns, int ptpv2)
> {
> struct sockaddr_in *from_addr = (struct sockaddr_in *)msg->msg_name;
> + size_t sync_len = ptpv2 ? sizeof(sync_v2) : sizeof(sync);
> + const void *sync_p = ptpv2 ? sync_v2 : sync;
> struct cmsghdr *cmsg;
> struct timeval tv;
> struct timespec ts;
> @@ -210,10 +228,9 @@ static void printpacket(struct msghdr *msg, int res,
> "probably SO_EE_ORIGIN_TIMESTAMPING"
> #endif
> );
> - if (res < sizeof(sync))
> + if (res < sync_len)
> printf(" => truncated data?!");
> - else if (!memcmp(sync, data + res - sizeof(sync),
> - sizeof(sync)))
> + else if (!memcmp(sync_p, data + res - sync_len, sync_len))
> printf(" => GOT OUR DATA BACK (HURRAY!)");
> break;
> }
> @@ -257,7 +274,7 @@ static void printpacket(struct msghdr *msg, int res,
> }
>
> static void recvpacket(int sock, int recvmsg_flags,
> - int siocgstamp, int siocgstampns)
> + int siocgstamp, int siocgstampns, int ptpv2)
> {
> char data[256];
> struct msghdr msg;
> @@ -288,7 +305,7 @@ static void recvpacket(int sock, int recvmsg_flags,
> } else {
> printpacket(&msg, res, data,
> sock, recvmsg_flags,
> - siocgstamp, siocgstampns);
> + siocgstamp, siocgstampns, ptpv2);
> }
> }
>
> @@ -300,6 +317,7 @@ int main(int argc, char **argv)
> int siocgstamp = 0;
> int siocgstampns = 0;
> int ip_multicast_loop = 0;
> + int ptpv2 = 0;
> char *interface;
> int i;
> int enabled = 1;
> @@ -335,6 +353,8 @@ int main(int argc, char **argv)
> siocgstampns = 1;
> else if (!strcasecmp(argv[i], "IP_MULTICAST_LOOP"))
> ip_multicast_loop = 1;
> + else if (!strcasecmp(argv[i], "PTPV2"))
> + ptpv2 = 1;
> else if (!strcasecmp(argv[i], "SOF_TIMESTAMPING_TX_HARDWARE"))
> so_timestamping_flags |= SOF_TIMESTAMPING_TX_HARDWARE;
> else if (!strcasecmp(argv[i], "SOF_TIMESTAMPING_TX_SOFTWARE"))
> @@ -369,6 +389,7 @@ int main(int argc, char **argv)
> HWTSTAMP_TX_ON : HWTSTAMP_TX_OFF;
> hwconfig.rx_filter =
> (so_timestamping_flags & SOF_TIMESTAMPING_RX_HARDWARE) ?
> + ptpv2 ? HWTSTAMP_FILTER_PTP_V2_L4_SYNC :
> HWTSTAMP_FILTER_PTP_V1_L4_SYNC : HWTSTAMP_FILTER_NONE;
> hwconfig_requested = hwconfig;
> if (ioctl(sock, SIOCSHWTSTAMP, &hwtstamp) < 0) {
> @@ -496,16 +517,16 @@ int main(int argc, char **argv)
> printf("has error\n");
> recvpacket(sock, 0,
> siocgstamp,
> - siocgstampns);
> + siocgstampns, ptpv2);
> recvpacket(sock, MSG_ERRQUEUE,
> siocgstamp,
> - siocgstampns);
> + siocgstampns, ptpv2);
> }
> } else {
> /* write one packet */
> sendpacket(sock,
> (struct sockaddr *)&addr,
> - sizeof(addr));
> + sizeof(addr), ptpv2);
> next.tv_sec += 5;
> continue;
> }
