Lines Matching refs:fep
98 static int fec_ptp_enable_pps(struct fec_enet_private *fep, uint enable) in fec_ptp_enable_pps() argument
106 if (fep->pps_enable == enable) in fec_ptp_enable_pps()
109 fep->pps_channel = DEFAULT_PPS_CHANNEL; in fec_ptp_enable_pps()
110 fep->reload_period = PPS_OUPUT_RELOAD_PERIOD; in fec_ptp_enable_pps()
112 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_ptp_enable_pps()
117 writel(FEC_T_TF_MASK, fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
123 val = readl(fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
126 writel(val, fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
127 val = readl(fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
131 timecounter_read(&fep->tc); in fec_ptp_enable_pps()
139 tempval = fep->cc.read(&fep->cc); in fec_ptp_enable_pps()
141 ns = timecounter_cyc2time(&fep->tc, tempval); in fec_ptp_enable_pps()
168 val &= fep->cc.mask; in fec_ptp_enable_pps()
169 writel(val, fep->hwp + FEC_TCCR(fep->pps_channel)); in fec_ptp_enable_pps()
172 fep->next_counter = (val + fep->reload_period) & fep->cc.mask; in fec_ptp_enable_pps()
175 val = readl(fep->hwp + FEC_ATIME_CTRL); in fec_ptp_enable_pps()
177 writel(val, fep->hwp + FEC_ATIME_CTRL); in fec_ptp_enable_pps()
180 val = readl(fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
185 writel(val, fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
190 writel(fep->next_counter, fep->hwp + FEC_TCCR(fep->pps_channel)); in fec_ptp_enable_pps()
191 fep->next_counter = (fep->next_counter + fep->reload_period) & fep->cc.mask; in fec_ptp_enable_pps()
193 writel(0, fep->hwp + FEC_TCSR(fep->pps_channel)); in fec_ptp_enable_pps()
196 fep->pps_enable = enable; in fec_ptp_enable_pps()
197 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_ptp_enable_pps()
212 struct fec_enet_private *fep = in fec_ptp_read() local
216 tempval = readl(fep->hwp + FEC_ATIME_CTRL); in fec_ptp_read()
218 writel(tempval, fep->hwp + FEC_ATIME_CTRL); in fec_ptp_read()
220 if (fep->quirks & FEC_QUIRK_BUG_CAPTURE) in fec_ptp_read()
223 return readl(fep->hwp + FEC_ATIME); in fec_ptp_read()
236 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_start_cyclecounter() local
240 inc = 1000000000 / fep->cycle_speed; in fec_ptp_start_cyclecounter()
243 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_ptp_start_cyclecounter()
246 writel(inc << FEC_T_INC_OFFSET, fep->hwp + FEC_ATIME_INC); in fec_ptp_start_cyclecounter()
249 writel(FEC_COUNTER_PERIOD, fep->hwp + FEC_ATIME_EVT_PERIOD); in fec_ptp_start_cyclecounter()
252 fep->hwp + FEC_ATIME_CTRL); in fec_ptp_start_cyclecounter()
254 memset(&fep->cc, 0, sizeof(fep->cc)); in fec_ptp_start_cyclecounter()
255 fep->cc.read = fec_ptp_read; in fec_ptp_start_cyclecounter()
256 fep->cc.mask = CLOCKSOURCE_MASK(31); in fec_ptp_start_cyclecounter()
257 fep->cc.shift = 31; in fec_ptp_start_cyclecounter()
258 fep->cc.mult = FEC_CC_MULT; in fec_ptp_start_cyclecounter()
261 timecounter_init(&fep->tc, &fep->cc, 0); in fec_ptp_start_cyclecounter()
263 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_ptp_start_cyclecounter()
286 struct fec_enet_private *fep = in fec_ptp_adjfreq() local
302 rhs = (u64)ppb * (u64)fep->ptp_inc; in fec_ptp_adjfreq()
303 for (i = 1; i <= fep->ptp_inc; i++) { in fec_ptp_adjfreq()
314 if (i > fep->ptp_inc) { in fec_ptp_adjfreq()
315 corr_inc = fep->ptp_inc; in fec_ptp_adjfreq()
320 corr_ns = fep->ptp_inc - corr_inc; in fec_ptp_adjfreq()
322 corr_ns = fep->ptp_inc + corr_inc; in fec_ptp_adjfreq()
324 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_ptp_adjfreq()
326 tmp = readl(fep->hwp + FEC_ATIME_INC) & FEC_T_INC_MASK; in fec_ptp_adjfreq()
328 writel(tmp, fep->hwp + FEC_ATIME_INC); in fec_ptp_adjfreq()
330 writel(corr_period, fep->hwp + FEC_ATIME_CORR); in fec_ptp_adjfreq()
332 timecounter_read(&fep->tc); in fec_ptp_adjfreq()
334 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_ptp_adjfreq()
348 struct fec_enet_private *fep = in fec_ptp_adjtime() local
352 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_ptp_adjtime()
353 timecounter_adjtime(&fep->tc, delta); in fec_ptp_adjtime()
354 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_ptp_adjtime()
401 struct fec_enet_private *fep = in fec_ptp_settime() local
408 mutex_lock(&fep->ptp_clk_mutex); in fec_ptp_settime()
410 if (!fep->ptp_clk_on) { in fec_ptp_settime()
411 mutex_unlock(&fep->ptp_clk_mutex); in fec_ptp_settime()
419 counter = ns & fep->cc.mask; in fec_ptp_settime()
421 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_ptp_settime()
422 writel(counter, fep->hwp + FEC_ATIME); in fec_ptp_settime()
423 timecounter_init(&fep->tc, &fep->cc, ns); in fec_ptp_settime()
424 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_ptp_settime()
425 mutex_unlock(&fep->ptp_clk_mutex); in fec_ptp_settime()
439 struct fec_enet_private *fep = in fec_ptp_enable() local
444 ret = fec_ptp_enable_pps(fep, on); in fec_ptp_enable()
457 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_disable_hwts() local
459 fep->hwts_tx_en = 0; in fec_ptp_disable_hwts()
460 fep->hwts_rx_en = 0; in fec_ptp_disable_hwts()
465 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_set() local
478 fep->hwts_tx_en = 0; in fec_ptp_set()
481 fep->hwts_tx_en = 1; in fec_ptp_set()
489 fep->hwts_rx_en = 0; in fec_ptp_set()
493 fep->hwts_rx_en = 1; in fec_ptp_set()
504 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_get() local
508 config.tx_type = fep->hwts_tx_en ? HWTSTAMP_TX_ON : HWTSTAMP_TX_OFF; in fec_ptp_get()
509 config.rx_filter = (fep->hwts_rx_en ? in fec_ptp_get()
523 struct fec_enet_private *fep = container_of(dwork, struct fec_enet_private, time_keep); in fec_time_keep() local
526 mutex_lock(&fep->ptp_clk_mutex); in fec_time_keep()
527 if (fep->ptp_clk_on) { in fec_time_keep()
528 spin_lock_irqsave(&fep->tmreg_lock, flags); in fec_time_keep()
529 timecounter_read(&fep->tc); in fec_time_keep()
530 spin_unlock_irqrestore(&fep->tmreg_lock, flags); in fec_time_keep()
532 mutex_unlock(&fep->ptp_clk_mutex); in fec_time_keep()
534 schedule_delayed_work(&fep->time_keep, HZ); in fec_time_keep()
541 struct fec_enet_private *fep = netdev_priv(ndev); in fec_pps_interrupt() local
543 u8 channel = fep->pps_channel; in fec_pps_interrupt()
546 val = readl(fep->hwp + FEC_TCSR(channel)); in fec_pps_interrupt()
551 writel(fep->next_counter, fep->hwp + FEC_TCCR(channel)); in fec_pps_interrupt()
553 writel(val, fep->hwp + FEC_TCSR(channel)); in fec_pps_interrupt()
554 } while (readl(fep->hwp + FEC_TCSR(channel)) & FEC_T_TF_MASK); in fec_pps_interrupt()
557 fep->next_counter = (fep->next_counter + fep->reload_period) & in fec_pps_interrupt()
558 fep->cc.mask; in fec_pps_interrupt()
561 ptp_clock_event(fep->ptp_clock, &event); in fec_pps_interrupt()
581 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_init() local
585 fep->ptp_caps.owner = THIS_MODULE; in fec_ptp_init()
586 strlcpy(fep->ptp_caps.name, "fec ptp", sizeof(fep->ptp_caps.name)); in fec_ptp_init()
588 fep->ptp_caps.max_adj = 250000000; in fec_ptp_init()
589 fep->ptp_caps.n_alarm = 0; in fec_ptp_init()
590 fep->ptp_caps.n_ext_ts = 0; in fec_ptp_init()
591 fep->ptp_caps.n_per_out = 0; in fec_ptp_init()
592 fep->ptp_caps.n_pins = 0; in fec_ptp_init()
593 fep->ptp_caps.pps = 1; in fec_ptp_init()
594 fep->ptp_caps.adjfreq = fec_ptp_adjfreq; in fec_ptp_init()
595 fep->ptp_caps.adjtime = fec_ptp_adjtime; in fec_ptp_init()
596 fep->ptp_caps.gettime64 = fec_ptp_gettime; in fec_ptp_init()
597 fep->ptp_caps.settime64 = fec_ptp_settime; in fec_ptp_init()
598 fep->ptp_caps.enable = fec_ptp_enable; in fec_ptp_init()
600 fep->cycle_speed = clk_get_rate(fep->clk_ptp); in fec_ptp_init()
601 if (!fep->cycle_speed) { in fec_ptp_init()
602 fep->cycle_speed = NSEC_PER_SEC; in fec_ptp_init()
603 dev_err(&fep->pdev->dev, "clk_ptp clock rate is zero\n"); in fec_ptp_init()
605 fep->ptp_inc = NSEC_PER_SEC / fep->cycle_speed; in fec_ptp_init()
607 spin_lock_init(&fep->tmreg_lock); in fec_ptp_init()
611 INIT_DELAYED_WORK(&fep->time_keep, fec_time_keep); in fec_ptp_init()
627 fep->ptp_clock = ptp_clock_register(&fep->ptp_caps, &pdev->dev); in fec_ptp_init()
628 if (IS_ERR(fep->ptp_clock)) { in fec_ptp_init()
629 fep->ptp_clock = NULL; in fec_ptp_init()
633 schedule_delayed_work(&fep->time_keep, HZ); in fec_ptp_init()
639 struct fec_enet_private *fep = netdev_priv(ndev); in fec_ptp_stop() local
641 cancel_delayed_work_sync(&fep->time_keep); in fec_ptp_stop()
642 if (fep->ptp_clock) in fec_ptp_stop()
643 ptp_clock_unregister(fep->ptp_clock); in fec_ptp_stop()