phc2sys: propagate received errors
Recognize errors returned in MANAGEMENT_ERROR_STATUS TLV and return a distinct value from run_pmc in case such error is received. Signed-off-by: Jiri Benc <jbenc@redhat.com>master
parent
175ca678e7
commit
00a663ca68
34
phc2sys.c
34
phc2sys.c
|
@ -526,9 +526,11 @@ static int is_msg_mgt(struct ptp_message *msg)
|
||||||
if (msg->tlv_count != 1)
|
if (msg->tlv_count != 1)
|
||||||
return 0;
|
return 0;
|
||||||
tlv = (struct TLV *) msg->management.suffix;
|
tlv = (struct TLV *) msg->management.suffix;
|
||||||
if (tlv->type != TLV_MANAGEMENT)
|
if (tlv->type == TLV_MANAGEMENT)
|
||||||
return 0;
|
return 1;
|
||||||
return 1;
|
if (tlv->type == TLV_MANAGEMENT_ERROR_STATUS)
|
||||||
|
return -1;
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int get_mgt_id(struct ptp_message *msg)
|
static int get_mgt_id(struct ptp_message *msg)
|
||||||
|
@ -543,6 +545,14 @@ static void *get_mgt_data(struct ptp_message *msg)
|
||||||
return mgt->data;
|
return mgt->data;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int get_mgt_err_id(struct ptp_message *msg)
|
||||||
|
{
|
||||||
|
struct management_error_status *mgt;
|
||||||
|
|
||||||
|
mgt = (struct management_error_status *)msg->management.suffix;
|
||||||
|
return mgt->id;
|
||||||
|
}
|
||||||
|
|
||||||
static int normalize_state(int state)
|
static int normalize_state(int state)
|
||||||
{
|
{
|
||||||
if (state != PS_MASTER && state != PS_SLAVE &&
|
if (state != PS_MASTER && state != PS_SLAVE &&
|
||||||
|
@ -630,12 +640,18 @@ static int init_pmc(struct node *node, int domain_number)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Return values:
|
||||||
|
* 1: success
|
||||||
|
* 0: timeout
|
||||||
|
* -1: error reported by the other side
|
||||||
|
* -2: local error, fatal
|
||||||
|
*/
|
||||||
static int run_pmc(struct node *node, int timeout, int ds_id,
|
static int run_pmc(struct node *node, int timeout, int ds_id,
|
||||||
struct ptp_message **msg)
|
struct ptp_message **msg)
|
||||||
{
|
{
|
||||||
#define N_FD 1
|
#define N_FD 1
|
||||||
struct pollfd pollfd[N_FD];
|
struct pollfd pollfd[N_FD];
|
||||||
int cnt;
|
int cnt, res;
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
pollfd[0].fd = pmc_get_transport_fd(node->pmc);
|
pollfd[0].fd = pmc_get_transport_fd(node->pmc);
|
||||||
|
@ -646,7 +662,7 @@ static int run_pmc(struct node *node, int timeout, int ds_id,
|
||||||
cnt = poll(pollfd, N_FD, timeout);
|
cnt = poll(pollfd, N_FD, timeout);
|
||||||
if (cnt < 0) {
|
if (cnt < 0) {
|
||||||
pr_err("poll failed");
|
pr_err("poll failed");
|
||||||
return -1;
|
return -2;
|
||||||
}
|
}
|
||||||
if (!cnt) {
|
if (!cnt) {
|
||||||
/* Request the data set again in the next run. */
|
/* Request the data set again in the next run. */
|
||||||
|
@ -676,8 +692,12 @@ static int run_pmc(struct node *node, int timeout, int ds_id,
|
||||||
if (!*msg)
|
if (!*msg)
|
||||||
continue;
|
continue;
|
||||||
|
|
||||||
if (!is_msg_mgt(*msg) ||
|
res = is_msg_mgt(*msg);
|
||||||
recv_subscribed(node, *msg, ds_id) ||
|
if (res < 0 && get_mgt_err_id(*msg) == ds_id) {
|
||||||
|
node->pmc_ds_requested = 0;
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
if (res <= 0 || recv_subscribed(node, *msg, ds_id) ||
|
||||||
get_mgt_id(*msg) != ds_id) {
|
get_mgt_id(*msg) != ds_id) {
|
||||||
msg_put(*msg);
|
msg_put(*msg);
|
||||||
*msg = NULL;
|
*msg = NULL;
|
||||||
|
|
Loading…
Reference in New Issue