cregit-Linux how code gets into the kernel

Release 4.11 drivers/net/ethernet/renesas/ravb_ptp.c

/* PTP 1588 clock using the Renesas Ethernet AVB
 *
 * Copyright (C) 2013-2015 Renesas Electronics Corporation
 * Copyright (C) 2015 Renesas Solutions Corp.
 * Copyright (C) 2015-2016 Cogent Embedded, Inc. <source@cogentembedded.com>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 */

#include "ravb.h"


static int ravb_ptp_tcr_request(struct ravb_private *priv, u32 request) { struct net_device *ndev = priv->ndev; int error; error = ravb_wait(ndev, GCCR, GCCR_TCR, GCCR_TCR_NOREQ); if (error) return error; ravb_modify(ndev, GCCR, request, request); return ravb_wait(ndev, GCCR, GCCR_TCR, GCCR_TCR_NOREQ); }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov69100.00%2100.00%
Total69100.00%2100.00%

/* Caller must hold the lock */
static int ravb_ptp_time_read(struct ravb_private *priv, struct timespec64 *ts) { struct net_device *ndev = priv->ndev; int error; error = ravb_ptp_tcr_request(priv, GCCR_TCR_CAPTURE); if (error) return error; ts->tv_nsec = ravb_read(ndev, GCT0); ts->tv_sec = ravb_read(ndev, GCT1) | ((s64)ravb_read(ndev, GCT2) << 32); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov83100.00%1100.00%
Total83100.00%1100.00%

/* Caller must hold the lock */
static int ravb_ptp_time_write(struct ravb_private *priv, const struct timespec64 *ts) { struct net_device *ndev = priv->ndev; int error; u32 gccr; error = ravb_ptp_tcr_request(priv, GCCR_TCR_RESET); if (error) return error; gccr = ravb_read(ndev, GCCR); if (gccr & GCCR_LTO) return -EBUSY; ravb_write(ndev, ts->tv_nsec, GTO0); ravb_write(ndev, ts->tv_sec, GTO1); ravb_write(ndev, (ts->tv_sec >> 32) & 0xffff, GTO2); ravb_write(ndev, gccr | GCCR_LTO, GCCR); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov120100.00%1100.00%
Total120100.00%1100.00%

/* Caller must hold the lock */
static int ravb_ptp_update_compare(struct ravb_private *priv, u32 ns) { struct net_device *ndev = priv->ndev; /* When the comparison value (GPTC.PTCV) is in range of * [x-1 to x+1] (x is the configured increment value in * GTI.TIV), it may happen that a comparison match is * not detected when the timer wraps around. */ u32 gti_ns_plus_1 = (priv->ptp.current_addend >> 20) + 1; u32 gccr; if (ns < gti_ns_plus_1) ns = gti_ns_plus_1; else if (ns > 0 - gti_ns_plus_1) ns = 0 - gti_ns_plus_1; gccr = ravb_read(ndev, GCCR); if (gccr & GCCR_LPTC) return -EBUSY; ravb_write(ndev, ns, GPTC); ravb_write(ndev, gccr | GCCR_LPTC, GCCR); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov109100.00%1100.00%
Total109100.00%1100.00%

/* PTP clock operations */
static int ravb_ptp_adjfreq(struct ptp_clock_info *ptp, s32 ppb) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); struct net_device *ndev = priv->ndev; unsigned long flags; u32 diff, addend; bool neg_adj = false; u32 gccr; if (ppb < 0) { neg_adj = true; ppb = -ppb; } addend = priv->ptp.default_addend; diff = div_u64((u64)addend * ppb, NSEC_PER_SEC); addend = neg_adj ? addend - diff : addend + diff; spin_lock_irqsave(&priv->lock, flags); priv->ptp.current_addend = addend; gccr = ravb_read(ndev, GCCR); if (gccr & GCCR_LTI) { spin_unlock_irqrestore(&priv->lock, flags); return -EBUSY; } ravb_write(ndev, addend & GTI_TIV, GTI); ravb_write(ndev, gccr | GCCR_LTI, GCCR); spin_unlock_irqrestore(&priv->lock, flags); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov18093.75%150.00%
Dan Carpenter126.25%150.00%
Total192100.00%2100.00%


static int ravb_ptp_adjtime(struct ptp_clock_info *ptp, s64 delta) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); struct timespec64 ts; unsigned long flags; int error; spin_lock_irqsave(&priv->lock, flags); error = ravb_ptp_time_read(priv, &ts); if (!error) { u64 now = ktime_to_ns(timespec64_to_ktime(ts)); ts = ns_to_timespec64(now + delta); error = ravb_ptp_time_write(priv, &ts); } spin_unlock_irqrestore(&priv->lock, flags); return error; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov112100.00%1100.00%
Total112100.00%1100.00%


static int ravb_ptp_gettime64(struct ptp_clock_info *ptp, struct timespec64 *ts) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); unsigned long flags; int error; spin_lock_irqsave(&priv->lock, flags); error = ravb_ptp_time_read(priv, ts); spin_unlock_irqrestore(&priv->lock, flags); return error; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov72100.00%1100.00%
Total72100.00%1100.00%


static int ravb_ptp_settime64(struct ptp_clock_info *ptp, const struct timespec64 *ts) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); unsigned long flags; int error; spin_lock_irqsave(&priv->lock, flags); error = ravb_ptp_time_write(priv, ts); spin_unlock_irqrestore(&priv->lock, flags); return error; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov73100.00%1100.00%
Total73100.00%1100.00%


static int ravb_ptp_extts(struct ptp_clock_info *ptp, struct ptp_extts_request *req, int on) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); struct net_device *ndev = priv->ndev; unsigned long flags; if (req->index) return -EINVAL; if (priv->ptp.extts[req->index] == on) return 0; priv->ptp.extts[req->index] = on; spin_lock_irqsave(&priv->lock, flags); if (priv->chip_id == RCAR_GEN2) ravb_modify(ndev, GIC, GIC_PTCE, on ? GIC_PTCE : 0); else if (on) ravb_write(ndev, GIE_PTCS, GIE); else ravb_write(ndev, GID_PTCD, GID); mmiowb(); spin_unlock_irqrestore(&priv->lock, flags); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov13180.37%266.67%
Kazuya Mizuguchi3219.63%133.33%
Total163100.00%3100.00%


static int ravb_ptp_perout(struct ptp_clock_info *ptp, struct ptp_perout_request *req, int on) { struct ravb_private *priv = container_of(ptp, struct ravb_private, ptp.info); struct net_device *ndev = priv->ndev; struct ravb_ptp_perout *perout; unsigned long flags; int error = 0; if (req->index) return -EINVAL; if (on) { u64 start_ns; u64 period_ns; start_ns = req->start.sec * NSEC_PER_SEC + req->start.nsec; period_ns = req->period.sec * NSEC_PER_SEC + req->period.nsec; if (start_ns > U32_MAX) { netdev_warn(ndev, "ptp: start value (nsec) is over limit. Maximum size of start is only 32 bits\n"); return -ERANGE; } if (period_ns > U32_MAX) { netdev_warn(ndev, "ptp: period value (nsec) is over limit. Maximum size of period is only 32 bits\n"); return -ERANGE; } spin_lock_irqsave(&priv->lock, flags); perout = &priv->ptp.perout[req->index]; perout->target = (u32)start_ns; perout->period = (u32)period_ns; error = ravb_ptp_update_compare(priv, (u32)start_ns); if (!error) { /* Unmask interrupt */ if (priv->chip_id == RCAR_GEN2) ravb_modify(ndev, GIC, GIC_PTME, GIC_PTME); else ravb_write(ndev, GIE_PTMS0, GIE); } } else { spin_lock_irqsave(&priv->lock, flags); perout = &priv->ptp.perout[req->index]; perout->period = 0; /* Mask interrupt */ if (priv->chip_id == RCAR_GEN2) ravb_modify(ndev, GIC, GIC_PTME, 0); else ravb_write(ndev, GID_PTMD0, GID); } mmiowb(); spin_unlock_irqrestore(&priv->lock, flags); return error; }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov28588.79%266.67%
Kazuya Mizuguchi3611.21%133.33%
Total321100.00%3100.00%


static int ravb_ptp_enable(struct ptp_clock_info *ptp, struct ptp_clock_request *req, int on) { switch (req->type) { case PTP_CLK_REQ_EXTTS: return ravb_ptp_extts(ptp, &req->extts, on); case PTP_CLK_REQ_PEROUT: return ravb_ptp_perout(ptp, &req->perout, on); default: return -EOPNOTSUPP; } }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov64100.00%1100.00%
Total64100.00%1100.00%

static const struct ptp_clock_info ravb_ptp_info = { .owner = THIS_MODULE, .name = "ravb clock", .max_adj = 50000000, .n_ext_ts = N_EXT_TS, .n_per_out = N_PER_OUT, .adjfreq = ravb_ptp_adjfreq, .adjtime = ravb_ptp_adjtime, .gettime64 = ravb_ptp_gettime64, .settime64 = ravb_ptp_settime64, .enable = ravb_ptp_enable, }; /* Caller must hold the lock */
void ravb_ptp_interrupt(struct net_device *ndev) { struct ravb_private *priv = netdev_priv(ndev); u32 gis = ravb_read(ndev, GIS); gis &= ravb_read(ndev, GIC); if (gis & GIS_PTCF) { struct ptp_clock_event event; event.type = PTP_CLOCK_EXTTS; event.index = 0; event.timestamp = ravb_read(ndev, GCPT); ptp_clock_event(priv->ptp.clock, &event); } if (gis & GIS_PTMF) { struct ravb_ptp_perout *perout = priv->ptp.perout; if (perout->period) { perout->target += perout->period; ravb_ptp_update_compare(priv, perout->target); } } ravb_write(ndev, ~gis, GIS); }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov140100.00%2100.00%
Total140100.00%2100.00%


void ravb_ptp_init(struct net_device *ndev, struct platform_device *pdev) { struct ravb_private *priv = netdev_priv(ndev); unsigned long flags; priv->ptp.info = ravb_ptp_info; priv->ptp.default_addend = ravb_read(ndev, GTI); priv->ptp.current_addend = priv->ptp.default_addend; spin_lock_irqsave(&priv->lock, flags); ravb_wait(ndev, GCCR, GCCR_TCR, GCCR_TCR_NOREQ); ravb_modify(ndev, GCCR, GCCR_TCSS, GCCR_TCSS_ADJGPTP); mmiowb(); spin_unlock_irqrestore(&priv->lock, flags); priv->ptp.clock = ptp_clock_register(&priv->ptp.info, &pdev->dev); }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov128100.00%2100.00%
Total128100.00%2100.00%


void ravb_ptp_stop(struct net_device *ndev) { struct ravb_private *priv = netdev_priv(ndev); ravb_write(ndev, 0, GIC); ravb_write(ndev, 0, GIS); ptp_clock_unregister(priv->ptp.clock); }

Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov47100.00%1100.00%
Total47100.00%1100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Sergei Shtylyov168095.45%360.00%
Kazuya Mizuguchi683.86%120.00%
Dan Carpenter120.68%120.00%
Total1760100.00%5100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.