You've already forked gitified_old_clb_svn
39 lines
819 B
C
39 lines
819 B
C
/*
|
|
* Copyright (C) 2012 CERN (www.cern.ch)
|
|
* Author: Aurelio Colosimo
|
|
* Based on ptp-noposix project (see AUTHORS for details)
|
|
*
|
|
* Released to the public domain
|
|
*/
|
|
|
|
#include <ppsi/ppsi.h>
|
|
#include "wr-api.h"
|
|
|
|
int wr_s_lock(struct pp_instance *ppi, unsigned char *pkt, int plen)
|
|
{
|
|
struct wr_dsport *wrp = WR_DSPOR(ppi);
|
|
int e = 0;
|
|
|
|
if (ppi->is_new_state) {
|
|
wrp->wrPortState = WRS_S_LOCK;
|
|
wrp->ops->locking_enable(ppi);
|
|
pp_timeout_set(ppi, PP_TO_EXT_0, WR_S_LOCK_TIMEOUT_MS);
|
|
}
|
|
|
|
if (pp_timeout_z(ppi, PP_TO_EXT_0)) {
|
|
ppi->next_state = PPS_FAULTY;
|
|
wrp->wrPortState = WRS_IDLE;
|
|
wrp->wrMode = NON_WR;
|
|
goto out;
|
|
}
|
|
|
|
if (wrp->ops->locking_poll(ppi, 0) == WR_SPLL_READY) {
|
|
ppi->next_state = WRS_LOCKED;
|
|
wrp->ops->locking_disable(ppi);
|
|
}
|
|
|
|
out:
|
|
ppi->next_delay = wrp->wrStateTimeout;
|
|
return e;
|
|
}
|