Aksal/nuttx-apps
1
0
Fork 1
mirror of https://github.com/apache/nuttx-apps.git synced 2026-08-18 02:38:24 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

netutils/ptpd: Add switch correction time change

Browse source 
The current gPTP stack does not support path delay correction of the Switch.
This patch adds the path delay correction field in the Header.

Signed-off-by: dongjiuzhu1 <dongjiuzhu1@xiaomi.com>
This commit is contained in:
dongjiuzhu1 2025-04-09 09:25:38 +08:00 • committed by Alan C. Assis
parent 03ca9ba500
commit e5c85d1ca2
1 changed files with 32 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

32
netutils/ptpd/ptpd.c
View file

@ -1236,6 +1236,31 @@ static int ptp_process_sync(FAR struct ptp_state_s *state,
return ptp_update_local_clock(state, &remote_time, &state->rxtime);
}
static void ptp_add_correction_time(FAR const uint8_t *correction,
FAR struct timespec *ts)
{
uint64_t correction_time = (((uint64_t)correction[0]) << 40)
| (((uint64_t)correction[1]) << 32)
| (((uint64_t)correction[2]) << 24)
| (((uint64_t)correction[3]) << 16)
| (((uint64_t)correction[4]) << 8)
| (((uint64_t)correction[5]) << 0);
ptpinfo("correction before: %lld.%09ld\n", (long long)ts->tv_sec,
ts->tv_nsec);
ts->tv_sec += correction_time / NSEC_PER_SEC;
ts->tv_nsec += correction_time % NSEC_PER_SEC;
if (ts->tv_nsec >= NSEC_PER_SEC)
{
ts->tv_nsec -= NSEC_PER_SEC;
ts->tv_sec += 1;
}
ptpinfo("correction after: %lld.%09ld\n", (long long)ts->tv_sec,
ts->tv_nsec);
}
static int ptp_process_followup(FAR struct ptp_state_s *state,
FAR struct ptp_follow_up_s *msg)
{
@ -1264,6 +1289,13 @@ static int ptp_process_followup(FAR struct ptp_state_s *state,
*/
ptp_format_to_timespec(msg->origintimestamp, &remote_time);
/* add correction time */
ptp_add_correction_time(msg->header.correction, &remote_time);
/* done */
return ptp_update_local_clock(state, &remote_time, &state->twostep_rxtime);
}