Skip to content

P
PPSi
Commit 0b21e2c6 authored by Sven Meier's avatar Sven Meier Committed by Adam Wujek
Browse files
Options

bmc: added hook for state machine extension 

A hook was added that handles the wr states, so that they don't get overwritten by bmc decisions.
The extension stays in the white rabbit states until a calibration is done.
parent 4dc9a628
Show whitespace changes
Inline Side-by-side
Showing with 81 additions and 52 deletions
arch-wrpc/wrc_ptp_ppsi.c
View file @ 0b21e2c6
...@@ -139,7 +139,7 @@ int wrc_ptp_set_mode(int mode) ...@@ -139,7 +139,7 @@ int wrc_ptp_set_mode(int mode)
shw_pps_gen_unmask_output(1); shw_pps_gen_unmask_output(1);
lock_timeout = LOCK_TIMEOUT_GM; lock_timeout = LOCK_TIMEOUT_GM;
DSDEF(ppi)->clockQuality.clockClass = PP_CLASS_WR_GM_LOCKED; DSDEF(ppi)->clockQuality.clockClass = PP_CLASS_WR_GM_LOCKED;
m1(ppi); bmc_m1(ppi);
break; break;
case WRC_MODE_MASTER: case WRC_MODE_MASTER:
...@@ -150,7 +150,7 @@ int wrc_ptp_set_mode(int mode) ...@@ -150,7 +150,7 @@ int wrc_ptp_set_mode(int mode)
shw_pps_gen_unmask_output(1); shw_pps_gen_unmask_output(1);
lock_timeout = LOCK_TIMEOUT_FM; lock_timeout = LOCK_TIMEOUT_FM;
DSDEF(ppi)->clockQuality.clockClass = PP_CLASS_DEFAULT; DSDEF(ppi)->clockQuality.clockClass = PP_CLASS_DEFAULT;
m1(ppi); bmc_m1(ppi);
break; break;
case WRC_MODE_SLAVE: case WRC_MODE_SLAVE:
......
include/ppsi/ppsi.h
View file @ 0b21e2c6
...@@ -166,6 +166,7 @@ struct pp_ext_hooks { ...@@ -166,6 +166,7 @@ struct pp_ext_hooks {
int (*handle_presp) (struct pp_instance * ppi); int (*handle_presp) (struct pp_instance * ppi);
int (*pack_announce)(struct pp_instance *ppi); int (*pack_announce)(struct pp_instance *ppi);
void (*unpack_announce)(void *buf, MsgAnnounce *ann); void (*unpack_announce)(void *buf, MsgAnnounce *ann);
int (*bmc_state_decision)(struct pp_instance *ppi, int next_state);
}; };
extern struct pp_ext_hooks pp_hooks; /* The one for the extension we build */ extern struct pp_ext_hooks pp_hooks; /* The one for the extension we build */
...@@ -359,8 +360,22 @@ extern void pp_servo_got_psync(struct pp_instance *ppi); /* got t1 and t2 */ ...@@ -359,8 +360,22 @@ extern void pp_servo_got_psync(struct pp_instance *ppi); /* got t1 and t2 */
extern void pp_servo_got_presp(struct pp_instance *ppi); /* got all t3..t6 */ extern void pp_servo_got_presp(struct pp_instance *ppi); /* got all t3..t6 */
/* bmc.c */ /* bmc.c */
extern void m1(struct pp_instance *ppi); extern void bmc_m1(struct pp_instance *ppi);
extern void bmc_m2(struct pp_instance *ppi);
extern void bmc_m3(struct pp_instance *ppi);
extern void bmc_s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann);
extern void bmc_p1(struct pp_instance *ppi);
extern void bmc_p2(struct pp_instance *ppi);
extern void bmc_copy_d0(struct pp_instance *ppi, struct pp_frgn_master *m);
extern int bmc_idcmp(struct ClockIdentity *a, struct ClockIdentity *b);
extern int bmc_pidcmp(struct PortIdentity *a, struct PortIdentity *b);
extern int bmc(struct pp_instance *ppi); extern int bmc(struct pp_instance *ppi);
extern int bmc_gm_cmp(struct pp_instance *ppi,
struct pp_frgn_master *a,
struct pp_frgn_master *b);
extern int bmc_topology_cmp(struct pp_instance *ppi,
struct pp_frgn_master *a,
struct pp_frgn_master *b);
extern int bmc_dataset_cmp(struct pp_instance *ppi, extern int bmc_dataset_cmp(struct pp_instance *ppi,
struct pp_frgn_master *a, struct pp_frgn_master *a,
struct pp_frgn_master *b); struct pp_frgn_master *b);
......
proto-ext-whiterabbit/hooks.c
View file @ 0b21e2c6
#include <ppsi/ppsi.h> #include <ppsi/ppsi.h>
#include "wr-api.h" #include "wr-api.h"
#include "../proto-standard/common-fun.h"
/* ext-whiterabbit must offer its own hooks */ /* ext-whiterabbit must offer its own hooks */
...@@ -164,7 +163,7 @@ static void wr_s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann) ...@@ -164,7 +163,7 @@ static void wr_s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann)
DSPOR(ppi)->portIdentity.portNumber; DSPOR(ppi)->portIdentity.portNumber;
} }
static int wr_execute_slave(struct pp_instance *ppi) int wr_execute_slave(struct pp_instance *ppi)
{ {
pp_diag(ppi, ext, 2, "hook: %s\n", __func__); pp_diag(ppi, ext, 2, "hook: %s\n", __func__);
...@@ -261,6 +260,28 @@ static void wr_unpack_announce(void *buf, MsgAnnounce *ann) ...@@ -261,6 +260,28 @@ static void wr_unpack_announce(void *buf, MsgAnnounce *ann)
msg_unpack_announce_wr_tlv(buf, ann); msg_unpack_announce_wr_tlv(buf, ann);
} }
/* State decision algorithm 9.3.3 Fig 26 with extension for wr */
static int wr_bmc_state_decision(struct pp_instance *ppi, int next_state)
{
pp_diag(ppi, ext, 2, "hook: %s\n", __func__);
/*
* if in one of the WR states stay in them,
* they will eventually go back to the normal states
*/
if ((ppi->state == WRS_PRESENT) ||
(ppi->state == WRS_M_LOCK) ||
(ppi->state == WRS_S_LOCK) ||
(ppi->state == WRS_LOCKED) ||
(ppi->state == WRS_CALIBRATION) ||
(ppi->state == WRS_CALIBRATED) ||
(ppi->state == WRS_RESP_CALIB_REQ) ||
(ppi->state == WRS_WR_LINK_ON))
return ppi->state;
/* else do the normal statemachine */
return next_state;
}
struct pp_ext_hooks pp_hooks = { struct pp_ext_hooks pp_hooks = {
.init = wr_init, .init = wr_init,
...@@ -278,4 +299,5 @@ struct pp_ext_hooks pp_hooks = { ...@@ -278,4 +299,5 @@ struct pp_ext_hooks pp_hooks = {
#endif #endif
.pack_announce = wr_pack_announce, .pack_announce = wr_pack_announce,
.unpack_announce = wr_unpack_announce, .unpack_announce = wr_unpack_announce,
.bmc_state_decision = wr_bmc_state_decision,
}; };
proto-ext-whiterabbit/state-wr-present.c
View file @ 0b21e2c6
...@@ -8,21 +8,6 @@ ...@@ -8,21 +8,6 @@
#include <ppsi/ppsi.h> #include <ppsi/ppsi.h>
#include "wr-api.h" #include "wr-api.h"
#include "../proto-standard/common-fun.h"
int wr_slave_execute(struct pp_instance *ppi)
{
int ret = 0;
if (pp_hooks.execute_slave)
ret = pp_hooks.execute_slave(ppi);
if (ret == 1) /* done: just return */
return 0;
if (ret < 0)
return ret;
return 0;
}
/* /*
* WRS_PRESENT is the entry point for a WR slave * WRS_PRESENT is the entry point for a WR slave
...@@ -62,7 +47,7 @@ int wr_present(struct pp_instance *ppi, unsigned char *pkt, int plen) ...@@ -62,7 +47,7 @@ int wr_present(struct pp_instance *ppi, unsigned char *pkt, int plen)
} }
if (e == 0) if (e == 0)
wr_slave_execute(ppi); wr_execute_slave(ppi);
else { else {
/* nothing, just stay here again */ /* nothing, just stay here again */
} }
......
proto-ext-whiterabbit/wr-api.h
View file @ 0b21e2c6
...@@ -100,7 +100,7 @@ int wr_abscal(struct pp_instance *ppi, unsigned char *pkt, int plen); ...@@ -100,7 +100,7 @@ int wr_abscal(struct pp_instance *ppi, unsigned char *pkt, int plen);
void wr_handshake_init(struct pp_instance *ppi, int mode); void wr_handshake_init(struct pp_instance *ppi, int mode);
void wr_handshake_fail(struct pp_instance *ppi); /* goto non-wr */ void wr_handshake_fail(struct pp_instance *ppi); /* goto non-wr */
int wr_handshake_retry(struct pp_instance *ppi); /* 1 == retry; 0 == failed */ int wr_handshake_retry(struct pp_instance *ppi); /* 1 == retry; 0 == failed */
int wr_execute_slave(struct pp_instance *ppi);
struct wr_servo_state; struct wr_servo_state;
/* White Rabbit hw-dependent functions (code in arch-wrpc and arch-wrs) */ /* White Rabbit hw-dependent functions (code in arch-wrpc and arch-wrs) */
......
proto-ext-whiterabbit/wr-msg.c
View file @ 0b21e2c6
...@@ -69,7 +69,7 @@ void msg_pack_announce_wr_tlv(struct pp_instance *ppi) ...@@ -69,7 +69,7 @@ void msg_pack_announce_wr_tlv(struct pp_instance *ppi)
class = PP_CLASS_WR_GM_LOCKED; class = PP_CLASS_WR_GM_LOCKED;
else else
class = PP_CLASS_WR_GM_UNLOCKED; class = PP_CLASS_WR_GM_UNLOCKED;
m1(ppi); bmc_m1(ppi);
if (class != DSDEF(ppi)->clockQuality.clockClass) { if (class != DSDEF(ppi)->clockQuality.clockClass) {
pp_error("New class %i\n", class); pp_error("New class %i\n", class);
DSDEF(ppi)->clockQuality.clockClass = class; DSDEF(ppi)->clockQuality.clockClass = class;
......
proto-standard/bmc.c
View file @ 0b21e2c6
...@@ -17,7 +17,7 @@ ...@@ -17,7 +17,7 @@
#define FFB_FTRA 0x20 #define FFB_FTRA 0x20
/* ppi->port_idx port is becoming Master. Table 13 (9.3.5) of the spec. */ /* ppi->port_idx port is becoming Master. Table 13 (9.3.5) of the spec. */
void m1(struct pp_instance *ppi) void bmc_m1(struct pp_instance *ppi)
{ {
struct DSParent *parent = DSPAR(ppi); struct DSParent *parent = DSPAR(ppi);
struct DSDefault *defds = DSDEF(ppi); struct DSDefault *defds = DSDEF(ppi);
...@@ -44,7 +44,7 @@ void m1(struct pp_instance *ppi) ...@@ -44,7 +44,7 @@ void m1(struct pp_instance *ppi)
} }
/* ppi->port_idx port is becoming Master. Table 13 (9.3.5) of the spec. */ /* ppi->port_idx port is becoming Master. Table 13 (9.3.5) of the spec. */
static void m2(struct pp_instance *ppi) void bmc_m2(struct pp_instance *ppi)
{ {
struct DSParent *parent = DSPAR(ppi); struct DSParent *parent = DSPAR(ppi);
struct DSDefault *defds = DSDEF(ppi); struct DSDefault *defds = DSDEF(ppi);
...@@ -71,7 +71,7 @@ static void m2(struct pp_instance *ppi) ...@@ -71,7 +71,7 @@ static void m2(struct pp_instance *ppi)
} }
/* ppi->port_idx port is becoming Master. Table 14 (9.3.5) of the spec. */ /* ppi->port_idx port is becoming Master. Table 14 (9.3.5) of the spec. */
static void m3(struct pp_instance *ppi) void bmc_m3(struct pp_instance *ppi)
{ {
/* In the default implementation, nothing should be done when a port /* In the default implementation, nothing should be done when a port
* goes to master state at m3. This empty function is a placeholder for * goes to master state at m3. This empty function is a placeholder for
...@@ -79,7 +79,7 @@ static void m3(struct pp_instance *ppi) ...@@ -79,7 +79,7 @@ static void m3(struct pp_instance *ppi)
} }
/* ppi->port_idx port is synchronized to Ebest Table 16 (9.3.5) of the spec. */ /* ppi->port_idx port is synchronized to Ebest Table 16 (9.3.5) of the spec. */
static void s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann) void bmc_s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann)
{ {
struct DSParent *parent = DSPAR(ppi); struct DSParent *parent = DSPAR(ppi);
struct DSTimeProperties *prop = DSPRO(ppi); struct DSTimeProperties *prop = DSPRO(ppi);
...@@ -113,14 +113,14 @@ static void s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann) ...@@ -113,14 +113,14 @@ static void s1(struct pp_instance *ppi, MsgHeader *hdr, MsgAnnounce *ann)
pp_hooks.s1(ppi, hdr, ann); pp_hooks.s1(ppi, hdr, ann);
} }
static void p1(struct pp_instance *ppi) void bmc_p1(struct pp_instance *ppi)
{ {
/* In the default implementation, nothing should be done when a port /* In the default implementation, nothing should be done when a port
* goes to passive state. This empty function is a placeholder for * goes to passive state. This empty function is a placeholder for
* extension-specific needs, to be implemented as a hook */ * extension-specific needs, to be implemented as a hook */
} }
static void p2(struct pp_instance *ppi) void bmc_p2(struct pp_instance *ppi)
{ {
/* In the default implementation, nothing should be done when a port /* In the default implementation, nothing should be done when a port
* goes to passive state. This empty function is a placeholder for * goes to passive state. This empty function is a placeholder for
...@@ -128,7 +128,7 @@ static void p2(struct pp_instance *ppi) ...@@ -128,7 +128,7 @@ static void p2(struct pp_instance *ppi)
} }
/* Copy local data set into header and ann message. 9.3.4 table 12. */ /* Copy local data set into header and ann message. 9.3.4 table 12. */
static void copy_d0(struct pp_instance *ppi, struct pp_frgn_master *m) void bmc_copy_d0(struct pp_instance *ppi, struct pp_frgn_master *m)
{ {
int i; int i;
struct DSDefault *defds = DSDEF(ppi); struct DSDefault *defds = DSDEF(ppi);
...@@ -154,18 +154,18 @@ static void copy_d0(struct pp_instance *ppi, struct pp_frgn_master *m) ...@@ -154,18 +154,18 @@ static void copy_d0(struct pp_instance *ppi, struct pp_frgn_master *m)
hdr->sourcePortIdentity.clockIdentity = defds->clockIdentity; hdr->sourcePortIdentity.clockIdentity = defds->clockIdentity;
} }
static int idcmp(struct ClockIdentity *a, struct ClockIdentity *b) int bmc_idcmp(struct ClockIdentity *a, struct ClockIdentity *b)
{ {
return memcmp(a, b, sizeof(*a)); return memcmp(a, b, sizeof(*a));
} }
static int pidcmp(struct PortIdentity *a, struct PortIdentity *b) int bmc_pidcmp(struct PortIdentity *a, struct PortIdentity *b)
{ {
return memcmp(a, b, sizeof(*a)); return memcmp(a, b, sizeof(*a));
} }
/* compare part2 of the datasets which is the topology, fig 27, page 89 */ /* compare part2 of the datasets which is the topology, fig 27, page 89 */
static int bmc_gm_cmp(struct pp_instance *ppi, int bmc_gm_cmp(struct pp_instance *ppi,
struct pp_frgn_master *a, struct pp_frgn_master *a,
struct pp_frgn_master *b) struct pp_frgn_master *b)
{ {
...@@ -251,11 +251,11 @@ static int bmc_gm_cmp(struct pp_instance *ppi, ...@@ -251,11 +251,11 @@ static int bmc_gm_cmp(struct pp_instance *ppi,
ab->grandmasterIdentity.id[2], ab->grandmasterIdentity.id[3], ab->grandmasterIdentity.id[2], ab->grandmasterIdentity.id[3],
ab->grandmasterIdentity.id[4], ab->grandmasterIdentity.id[5], ab->grandmasterIdentity.id[4], ab->grandmasterIdentity.id[5],
ab->grandmasterIdentity.id[6], ab->grandmasterIdentity.id[7]); ab->grandmasterIdentity.id[6], ab->grandmasterIdentity.id[7]);
return idcmp(&aa->grandmasterIdentity, &ab->grandmasterIdentity); return bmc_idcmp(&aa->grandmasterIdentity, &ab->grandmasterIdentity);
} }
/* compare part2 of the datasets which is the topology, fig 28, page 90 */ /* compare part2 of the datasets which is the topology, fig 28, page 90 */
static int bmc_topology_cmp(struct pp_instance *ppi, int bmc_topology_cmp(struct pp_instance *ppi,
struct pp_frgn_master *a, struct pp_frgn_master *a,
struct pp_frgn_master *b) struct pp_frgn_master *b)
{ {
...@@ -310,7 +310,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi, ...@@ -310,7 +310,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi,
} }
if (diff > 0) { if (diff > 0) {
if (!pidcmp(pidtxa, pidrxa)) { if (!bmc_pidcmp(pidtxa, pidrxa)) {
pp_diag(ppi, bmc, 1, "%s:%i: Error 1\n", pp_diag(ppi, bmc, 1, "%s:%i: Error 1\n",
__func__, __LINE__); __func__, __LINE__);
return 0; return 0;
...@@ -321,7 +321,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi, ...@@ -321,7 +321,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi,
} }
if (diff < 0) { if (diff < 0) {
if (!pidcmp(pidtxb, pidrxb)) { if (!bmc_pidcmp(pidtxb, pidrxb)) {
pp_diag(ppi, bmc, 1, "%s:%i: Error 1\n", pp_diag(ppi, bmc, 1, "%s:%i: Error 1\n",
__func__, __LINE__); __func__, __LINE__);
return 0; return 0;
...@@ -331,7 +331,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi, ...@@ -331,7 +331,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi,
return -1; return -1;
} }
/* stepsRemoved is equal, compare identities */ /* stepsRemoved is equal, compare identities */
diff = pidcmp(pidtxa, pidtxb); diff = bmc_pidcmp(pidtxa, pidtxb);
if (diff) { if (diff) {
pp_diag(ppi, bmc, 3, "TxId A: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x.%04x,\n" pp_diag(ppi, bmc, 3, "TxId A: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x.%04x,\n"
"TxId B: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x.%04x\n", "TxId B: %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x.%04x\n",
...@@ -362,7 +362,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi, ...@@ -362,7 +362,7 @@ static int bmc_topology_cmp(struct pp_instance *ppi,
pidrxb->clockIdentity.id[4], pidrxb->clockIdentity.id[5], pidrxb->clockIdentity.id[4], pidrxb->clockIdentity.id[5],
pidrxb->clockIdentity.id[6], pidrxb->clockIdentity.id[7], pidrxb->clockIdentity.id[6], pidrxb->clockIdentity.id[7],
pidrxb->portNumber); pidrxb->portNumber);
return pidcmp(pidrxa, pidrxb); return bmc_pidcmp(pidrxa, pidrxb);
} }
/* /*
...@@ -381,7 +381,7 @@ int bmc_dataset_cmp(struct pp_instance *ppi, ...@@ -381,7 +381,7 @@ int bmc_dataset_cmp(struct pp_instance *ppi,
/* dataset_cmp is called several times, so report only at level 2 */ /* dataset_cmp is called several times, so report only at level 2 */
pp_diag(ppi, bmc, 2, "%s\n", __func__); pp_diag(ppi, bmc, 2, "%s\n", __func__);
if (!idcmp(&aa->grandmasterIdentity, &ab->grandmasterIdentity)) { if (!bmc_idcmp(&aa->grandmasterIdentity, &ab->grandmasterIdentity)) {
/* Check topology */ /* Check topology */
return bmc_topology_cmp(ppi, a, b); return bmc_topology_cmp(ppi, a, b);
} else { } else {
...@@ -416,7 +416,7 @@ static int bmc_state_decision(struct pp_instance *ppi) ...@@ -416,7 +416,7 @@ static int bmc_state_decision(struct pp_instance *ppi)
return PPS_LISTENING; return PPS_LISTENING;
/* copy local information to a foreign_master structure */ /* copy local information to a foreign_master structure */
copy_d0(ppi, &d0); bmc_copy_d0(ppi, &d0);
if (ppi->role == PPSI_ROLE_MASTER) { if (ppi->role == PPSI_ROLE_MASTER) {
...@@ -493,21 +493,21 @@ passive_p1: ...@@ -493,21 +493,21 @@ passive_p1:
pp_diag(ppi, bmc, 1, "%s: passive p1\n", __func__); pp_diag(ppi, bmc, 1, "%s: passive p1\n", __func__);
if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY) if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY)
return PPS_LISTENING; return PPS_LISTENING;
p1(ppi); bmc_p1(ppi);
return PPS_PASSIVE; return PPS_PASSIVE;
passive_p2: passive_p2:
pp_diag(ppi, bmc, 1, "%s: passive p2\n", __func__); pp_diag(ppi, bmc, 1, "%s: passive p2\n", __func__);
if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY) if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY)
return PPS_LISTENING; return PPS_LISTENING;
p2(ppi); bmc_p2(ppi);
return PPS_PASSIVE; return PPS_PASSIVE;
master_m1: master_m1:
pp_diag(ppi, bmc, 1, "%s: master m1\n", __func__); pp_diag(ppi, bmc, 1, "%s: master m1\n", __func__);
if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY) if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY)
return PPS_LISTENING; return PPS_LISTENING;
m1(ppi); bmc_m1(ppi);
if (ppi->state != PPS_MASTER) { if (ppi->state != PPS_MASTER) {
/* if not already in pre master state start qualification */ /* if not already in pre master state start qualification */
if (ppi->state != PPS_PRE_MASTER) { if (ppi->state != PPS_PRE_MASTER) {
...@@ -522,7 +522,7 @@ master_m2: ...@@ -522,7 +522,7 @@ master_m2:
pp_diag(ppi, bmc, 1, "%s: master m2\n", __func__); pp_diag(ppi, bmc, 1, "%s: master m2\n", __func__);
if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY) if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY)
return PPS_LISTENING; return PPS_LISTENING;
m2(ppi); bmc_m2(ppi);
if (ppi->state != PPS_MASTER) { if (ppi->state != PPS_MASTER) {
/* if not already in pre master state start qualification */ /* if not already in pre master state start qualification */
if (ppi->state != PPS_PRE_MASTER) { if (ppi->state != PPS_PRE_MASTER) {
...@@ -537,7 +537,7 @@ master_m3: ...@@ -537,7 +537,7 @@ master_m3:
pp_diag(ppi, bmc, 1, "%s: master m3\n", __func__); pp_diag(ppi, bmc, 1, "%s: master m3\n", __func__);
if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY) if (DSDEF(ppi)->clockQuality.clockClass == PP_CLASS_SLAVE_ONLY)
return PPS_LISTENING; return PPS_LISTENING;
m3(ppi); bmc_m3(ppi);
if (ppi->state != PPS_MASTER) { if (ppi->state != PPS_MASTER) {
/* if not already in pre master state start qualification */ /* if not already in pre master state start qualification */
if (ppi->state != PPS_PRE_MASTER) { if (ppi->state != PPS_PRE_MASTER) {
...@@ -553,9 +553,9 @@ slave_s1: ...@@ -553,9 +553,9 @@ slave_s1:
/* only update parent dataset if best master is on this port */ /* only update parent dataset if best master is on this port */
if (ppi->port_idx == GLBS(ppi)->ebest_idx) { if (ppi->port_idx == GLBS(ppi)->ebest_idx) {
/* check if we have a new master */ /* check if we have a new master */
cmpres = pidcmp(&parent->parentPortIdentity, cmpres = bmc_pidcmp(&parent->parentPortIdentity,
&ebest->hdr.sourcePortIdentity); &ebest->hdr.sourcePortIdentity);
s1(ppi, &ebest->hdr, &ebest->ann); bmc_s1(ppi, &ebest->hdr, &ebest->ann);
} else { } else {
/* set that to zero in the case we don't have the master master /* set that to zero in the case we don't have the master master
* on that port */ * on that port */
...@@ -759,6 +759,7 @@ static void bmc_update_ebest(struct pp_globals *ppg) ...@@ -759,6 +759,7 @@ static void bmc_update_ebest(struct pp_globals *ppg)
int bmc(struct pp_instance *ppi) int bmc(struct pp_instance *ppi)
{ {
struct pp_globals *ppg = GLBS(ppi); struct pp_globals *ppg = GLBS(ppi);
int next_state;
/* bmc is called several times, so report only at level 2 */ /* bmc is called several times, so report only at level 2 */
pp_diag(ppi, bmc, 2, "%s\n", __func__); pp_diag(ppi, bmc, 2, "%s\n", __func__);
...@@ -784,6 +785,12 @@ int bmc(struct pp_instance *ppi) ...@@ -784,6 +785,12 @@ int bmc(struct pp_instance *ppi)
/* Calulate Ebest Figure 25 */ /* Calulate Ebest Figure 25 */
bmc_update_ebest(ppg); bmc_update_ebest(ppg);
/* Make state decision*/ /* Make state decision */
return bmc_state_decision(ppi); next_state = bmc_state_decision(ppi);
/* Extra states handled here */
if (pp_hooks.bmc_state_decision)
next_state = pp_hooks.bmc_state_decision(ppi, next_state);
return next_state;
} }
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment