compliance, 11.4.3 b: peer-delay, fix support for 1-step

If no follow-up is to be received, we trigger pp_servo_got_presp() on reception of peer delay response.

compliance, 11.4.3 b: peer-delay, fix support for 1-step
If no follow-up is to be received, we trigger pp_servo_got_presp() on reception of peer delay response.
4f221227 · Davide Ciminaghi · Alessandro Rubini · c7627fa8 · 4f221227
Commit 4f221227 authored Jul 23, 2016 by Davide Ciminaghi Committed by Alessandro Rubini Sep 20, 2016
Show whitespace changes
Inline Side-by-side

Showing with 8 additions and 1 deletion

common-fun.c proto-standard/common-fun.c +8 -1

No files found.
--- a/proto-standard/common-fun.c
+++ b/proto-standard/common-fun.c
@@ -198,6 +198,7 @@ int st_com_peer_handle_pres(struct pp_instance *ppi, unsigned char *buf,
 {
 	MsgPDelayResp resp;
 	MsgHeader *hdr = &ppi->received_ptp_header;
+	int e = 0;
 	if (len < PP_PDELAY_RESP_LENGTH)
 		return -1;
@@ -230,11 +231,17 @@ int st_com_peer_handle_pres(struct pp_instance *ppi, unsigned char *buf,
 		/* Save correctionField of pdelay_resp, see 11.4.3 d 3/4 */
 		cField_to_TimeInternal(&ppi->cField, hdr->correctionfield);
+		if (!(hdr->flagField[0] & PP_TWO_STEP_FLAG)) {
+			if (pp_hooks.handle_presp)
+				e = pp_hooks.handle_presp(ppi);
+			else
+				pp_servo_got_presp(ppi);
+		}
 	} else {
 		pp_diag(ppi, frames, 2, "pp_pclock : "
 			"PDelay Resp doesn't match PDelay Req\n");
 	}
-	return 0;
+	return e;
 }