|
@@ -47,7 +47,7 @@
|
|
|
#define PSF_TX 0x1000
|
|
|
#define EXT_EVENT 1
|
|
|
#define CAL_EVENT 7
|
|
|
-#define CAL_TRIGGER 7
|
|
|
+#define CAL_TRIGGER 1
|
|
|
#define DP83640_N_PINS 12
|
|
|
|
|
|
#define MII_DP83640_MICR 0x11
|
|
@@ -496,7 +496,9 @@ static int ptp_dp83640_enable(struct ptp_clock_info *ptp,
|
|
|
else
|
|
|
evnt |= EVNT_RISE;
|
|
|
}
|
|
|
+ mutex_lock(&clock->extreg_lock);
|
|
|
ext_write(0, phydev, PAGE5, PTP_EVNT, evnt);
|
|
|
+ mutex_unlock(&clock->extreg_lock);
|
|
|
return 0;
|
|
|
|
|
|
case PTP_CLK_REQ_PEROUT:
|
|
@@ -532,6 +534,8 @@ static u8 status_frame_src[6] = { 0x08, 0x00, 0x17, 0x0B, 0x6B, 0x0F };
|
|
|
|
|
|
static void enable_status_frames(struct phy_device *phydev, bool on)
|
|
|
{
|
|
|
+ struct dp83640_private *dp83640 = phydev->priv;
|
|
|
+ struct dp83640_clock *clock = dp83640->clock;
|
|
|
u16 cfg0 = 0, ver;
|
|
|
|
|
|
if (on)
|
|
@@ -539,9 +543,13 @@ static void enable_status_frames(struct phy_device *phydev, bool on)
|
|
|
|
|
|
ver = (PSF_PTPVER & VERSIONPTP_MASK) << VERSIONPTP_SHIFT;
|
|
|
|
|
|
+ mutex_lock(&clock->extreg_lock);
|
|
|
+
|
|
|
ext_write(0, phydev, PAGE5, PSF_CFG0, cfg0);
|
|
|
ext_write(0, phydev, PAGE6, PSF_CFG1, ver);
|
|
|
|
|
|
+ mutex_unlock(&clock->extreg_lock);
|
|
|
+
|
|
|
if (!phydev->attached_dev) {
|
|
|
pr_warn("expected to find an attached netdevice\n");
|
|
|
return;
|
|
@@ -838,7 +846,7 @@ static void decode_rxts(struct dp83640_private *dp83640,
|
|
|
list_del_init(&rxts->list);
|
|
|
phy2rxts(phy_rxts, rxts);
|
|
|
|
|
|
- spin_lock_irqsave(&dp83640->rx_queue.lock, flags);
|
|
|
+ spin_lock(&dp83640->rx_queue.lock);
|
|
|
skb_queue_walk(&dp83640->rx_queue, skb) {
|
|
|
struct dp83640_skb_info *skb_info;
|
|
|
|
|
@@ -853,7 +861,7 @@ static void decode_rxts(struct dp83640_private *dp83640,
|
|
|
break;
|
|
|
}
|
|
|
}
|
|
|
- spin_unlock_irqrestore(&dp83640->rx_queue.lock, flags);
|
|
|
+ spin_unlock(&dp83640->rx_queue.lock);
|
|
|
|
|
|
if (!shhwtstamps)
|
|
|
list_add_tail(&rxts->list, &dp83640->rxts);
|
|
@@ -1173,11 +1181,18 @@ static int dp83640_config_init(struct phy_device *phydev)
|
|
|
|
|
|
if (clock->chosen && !list_empty(&clock->phylist))
|
|
|
recalibrate(clock);
|
|
|
- else
|
|
|
+ else {
|
|
|
+ mutex_lock(&clock->extreg_lock);
|
|
|
enable_broadcast(phydev, clock->page, 1);
|
|
|
+ mutex_unlock(&clock->extreg_lock);
|
|
|
+ }
|
|
|
|
|
|
enable_status_frames(phydev, true);
|
|
|
+
|
|
|
+ mutex_lock(&clock->extreg_lock);
|
|
|
ext_write(0, phydev, PAGE4, PTP_CTL, PTP_ENABLE);
|
|
|
+ mutex_unlock(&clock->extreg_lock);
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
|