mirrors/pipewire
1
0
Fork 0
mirror of https://gitlab.freedesktop.org/pipewire/pipewire.git synced 2026-05-03 06:47:04 -04:00
Code Issues Projects Releases Packages Wiki Activity Actions

milan-avb: gptp: align code style with the rest of module-avb

Browse source
This commit is contained in:
hackerman-kl 2026-04-28 07:35:42 +02:00
parent 0345623e97
commit b197ae79c5
1 changed files with 39 additions and 46 deletions
Download patch file Download diff file Expand all files Collapse all files

81
src/modules/module-avb/gptp.c
View file

@ -40,7 +40,8 @@ struct gptp {
uint8_t gm_id[8]; uint8_t gm_id[8];
}; };
static int make_unix_ptp_mgmt_socket(const char *path) { static int make_unix_ptp_mgmt_socket(const char *path)
{
struct sockaddr_un addr; struct sockaddr_un addr;
spa_autoclose int fd = socket(AF_UNIX, SOCK_DGRAM | SOCK_CLOEXEC, 0); spa_autoclose int fd = socket(AF_UNIX, SOCK_DGRAM | SOCK_CLOEXEC, 0);
@ -67,7 +68,21 @@ static int make_unix_ptp_mgmt_socket(const char *path) {
return spa_steal_fd(fd); return spa_steal_fd(fd);
} }
static bool update_ts_refclk(struct gptp *gptp) { static bool update_ts_refclk(struct gptp *gptp)
{
struct ptp_management_msg req;
struct ptp_management_msg res;
struct ptp_parent_data_set parent;
struct timespec now;
uint8_t buf[sizeof(struct ptp_management_msg) + sizeof(struct ptp_parent_data_set)];
uint8_t *cid;
uint8_t *gmid;
uint8_t tmp;
ssize_t ret;
uint16_t data_len;
int avail;
bool gmid_changed = false;
if (!gptp->ptp_mgmt_socket_path) if (!gptp->ptp_mgmt_socket_path)
return false; return false;
if (gptp->ptp_fd < 0) { if (gptp->ptp_fd < 0) {
@ -76,11 +91,7 @@ static bool update_ts_refclk(struct gptp *gptp) {
return false; return false;
} }
// Read if something is left in the socket /* Read if something is left in the socket */
int avail;
uint8_t tmp;
ssize_t ret;
if (ioctl(gptp->ptp_fd, FIONREAD, &avail) == -1) { if (ioctl(gptp->ptp_fd, FIONREAD, &avail) == -1) {
pw_log_warn("Failed to get number of byes in ptp_fd input buffer: %m"); pw_log_warn("Failed to get number of byes in ptp_fd input buffer: %m");
return false; return false;
@ -92,7 +103,6 @@ static bool update_ts_refclk(struct gptp *gptp) {
return false; return false;
} }
struct ptp_management_msg req;
spa_zero(req); spa_zero(req);
req.major_sdo_id_message_type = PTP_MESSAGE_TYPE_MANAGEMENT; req.major_sdo_id_message_type = PTP_MESSAGE_TYPE_MANAGEMENT;
@ -108,7 +118,7 @@ static bool update_ts_refclk(struct gptp *gptp) {
req.boundary_hops = 1; req.boundary_hops = 1;
req.action = PTP_MGMT_ACTION_GET; req.action = PTP_MGMT_ACTION_GET;
req.tlv_type_be = htons(PTP_TLV_TYPE_MGMT); req.tlv_type_be = htons(PTP_TLV_TYPE_MGMT);
// sent empty TLV, only sending management_id /* sent empty TLV, only sending management_id */
req.management_message_length_be = htons(2); req.management_message_length_be = htons(2);
req.management_id_be = htons(PTP_MGMT_ID_PARENT_DATA_SET); req.management_id_be = htons(PTP_MGMT_ID_PARENT_DATA_SET);
@ -128,7 +138,6 @@ static bool update_ts_refclk(struct gptp *gptp) {
return false; return false;
} }
uint8_t buf[sizeof(struct ptp_management_msg) + sizeof(struct ptp_parent_data_set)];
ret = read(gptp->ptp_fd, &buf, sizeof(buf)); ret = read(gptp->ptp_fd, &buf, sizeof(buf));
if (ret == -1) { if (ret == -1) {
pw_log_warn("Failed to receive PTP management response: %m"); pw_log_warn("Failed to receive PTP management response: %m");
@ -140,9 +149,8 @@ static bool update_ts_refclk(struct gptp *gptp) {
return false; return false;
} }
struct ptp_management_msg res = *(struct ptp_management_msg *)buf; res = *(struct ptp_management_msg *)buf;
struct ptp_parent_data_set parent = parent = *(struct ptp_parent_data_set *)(buf + sizeof(struct ptp_management_msg));
*(struct ptp_parent_data_set *)(buf + sizeof(struct ptp_management_msg));
if ((res.ver & 0x0f) != 2) { if ((res.ver & 0x0f) != 2) {
pw_log_warn("PTP major version is %d, expected 2", res.ver); pw_log_warn("PTP major version is %d, expected 2", res.ver);
@ -169,47 +177,32 @@ static bool update_ts_refclk(struct gptp *gptp) {
return false; return false;
} }
uint16_t data_len = ntohs(res.management_message_length_be) - 2; data_len = ntohs(res.management_message_length_be) - 2;
if (data_len != sizeof(struct ptp_parent_data_set)) if (data_len != sizeof(struct ptp_parent_data_set))
pw_log_warn("Unexpected PTP GET PARENT_DATA_SET response length %u, expected %zu", data_len, sizeof(struct ptp_parent_data_set)); pw_log_warn("Unexpected PTP GET PARENT_DATA_SET response length %u, expected %zu",
data_len, sizeof(struct ptp_parent_data_set));
uint8_t *cid = res.clock_identity; cid = res.clock_identity;
if (memcmp(cid, gptp->clock_id, 8) != 0) if (memcmp(cid, gptp->clock_id, 8) != 0)
pw_log_info( pw_log_info("Local clock ID: IEEE1588-2008:"
"Local clock ID: IEEE1588-2008:%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X:%d", "%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X:%d",
cid[0], cid[0], cid[1], cid[2], cid[3],
cid[1], cid[4], cid[5], cid[6], cid[7],
cid[2], 0 /* domain */);
cid[3],
cid[4],
cid[5],
cid[6],
cid[7],
0 /* domain */
);
uint8_t *gmid = parent.gm_clock_id; gmid = parent.gm_clock_id;
bool gmid_changed = false;
if (memcmp(gmid, gptp->gm_id, 8) != 0) { if (memcmp(gmid, gptp->gm_id, 8) != 0) {
pw_log_info( pw_log_info("GM ID: IEEE1588-2008:"
"GM ID: IEEE1588-2008:%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X:%d", "%02X-%02X-%02X-%02X-%02X-%02X-%02X-%02X:%d",
gmid[0], gmid[0], gmid[1], gmid[2], gmid[3],
gmid[1], gmid[4], gmid[5], gmid[6], gmid[7],
gmid[2], 0 /* domain */);
gmid[3],
gmid[4],
gmid[5],
gmid[6],
gmid[7],
0 /* domain */
);
gmid_changed = true; gmid_changed = true;
} }
// When GM is not equal to own clock we are clocked by external master /* When GM is not equal to own clock we are clocked by external master */
pw_log_debug("Synced to GM: %s", (memcmp(cid, gmid, 8) != 0) ? "true" : "false"); pw_log_debug("Synced to GM: %s", (memcmp(cid, gmid, 8) != 0) ? "true" : "false");
struct timespec now;
memcpy(gptp->clock_id, cid, 8); memcpy(gptp->clock_id, cid, 8);
memcpy(gptp->gm_id, gmid, 8); memcpy(gptp->gm_id, gmid, 8);