Release 4.18 drivers/net/ethernet/stmicro/stmmac/stmmac_ptp.c

/*******************************************************************************
  PTP 1588 clock using the STMMAC.

  Copyright (C) 2013  Vayavya Labs Pvt Ltd

  This program is free software; you can redistribute it and/or modify it
  under the terms and conditions of the GNU General Public License,
  version 2, as published by the Free Software Foundation.

  This program is distributed in the hope it will be useful, but WITHOUT
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  more details.

  The full GNU General Public License is included in this distribution in
  the file called "COPYING".

  Author: Rayagond Kokatanur <rayagond@vayavyalabs.com>
*******************************************************************************/
#include "stmmac.h"
#include "stmmac_ptp.h"

/**
 * stmmac_adjust_freq
 *
 * @ptp: pointer to ptp_clock_info structure
 * @ppb: desired period change in parts ber billion
 *
 * Description: this function will adjust the frequency of hardware clock.
 */


static int stmmac_adjust_freq(struct ptp_clock_info *ptp, s32 ppb)
{
	struct stmmac_priv *priv =
	    container_of(ptp, struct stmmac_priv, ptp_clock_ops);
	unsigned long flags;
	u32 diff, addend;
	int neg_adj = 0;
	u64 adj;

	if (ppb < 0) {
		neg_adj = 1;
		ppb = -ppb;
	}

	addend = priv->default_addend;
	adj = addend;
	adj *= ppb;
	diff = div_u64(adj, 1000000000ULL);
	addend = neg_adj ? (addend - diff) : (addend + diff);

	spin_lock_irqsave(&priv->ptp_lock, flags);
	stmmac_config_addend(priv, priv->ptpaddr, addend);
	spin_unlock_irqrestore(&priv->ptp_lock, flags);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
131
96.32%
1
25.00%
Jose Abreu
3
2.21%
1
25.00%
Vince Bridgers
1
0.74%
1
25.00%
Giuseppe Cavallaro
1
0.74%
1
25.00%
Total
136
100.00%
4
100.00%

/**
 * stmmac_adjust_time
 *
 * @ptp: pointer to ptp_clock_info structure
 * @delta: desired change in nanoseconds
 *
 * Description: this function will shift/adjust the hardware clock time.
 */


static int stmmac_adjust_time(struct ptp_clock_info *ptp, s64 delta)
{
	struct stmmac_priv *priv =
	    container_of(ptp, struct stmmac_priv, ptp_clock_ops);
	unsigned long flags;
	u32 sec, nsec;
	u32 quotient, reminder;
	int neg_adj = 0;

	if (delta < 0) {
		neg_adj = 1;
		delta = -delta;
	}

	quotient = div_u64_rem(delta, 1000000000ULL, &reminder);
	sec = quotient;
	nsec = reminder;

	spin_lock_irqsave(&priv->ptp_lock, flags);
	stmmac_adjust_systime(priv, priv->ptpaddr, sec, nsec, neg_adj,
			priv->plat->has_gmac4);
	spin_unlock_irqrestore(&priv->ptp_lock, flags);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
118
91.47%
1
25.00%
Giuseppe Cavallaro
7
5.43%
1
25.00%
Jose Abreu
3
2.33%
1
25.00%
Vince Bridgers
1
0.78%
1
25.00%
Total
129
100.00%
4
100.00%

/**
 * stmmac_get_time
 *
 * @ptp: pointer to ptp_clock_info structure
 * @ts: pointer to hold time/result
 *
 * Description: this function will read the current time from the
 * hardware clock and store it in @ts.
 */


static int stmmac_get_time(struct ptp_clock_info *ptp, struct timespec64 *ts)
{
	struct stmmac_priv *priv =
	    container_of(ptp, struct stmmac_priv, ptp_clock_ops);
	unsigned long flags;
	u64 ns;

	spin_lock_irqsave(&priv->ptp_lock, flags);
	stmmac_get_systime(priv, priv->ptpaddr, &ns);
	spin_unlock_irqrestore(&priv->ptp_lock, flags);

	*ts = ns_to_timespec64(ns);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
71
87.65%
1
20.00%
Jose Abreu
6
7.41%
1
20.00%
Richard Cochran
3
3.70%
2
40.00%
Giuseppe Cavallaro
1
1.23%
1
20.00%
Total
81
100.00%
5
100.00%

/**
 * stmmac_set_time
 *
 * @ptp: pointer to ptp_clock_info structure
 * @ts: time value to set
 *
 * Description: this function will set the current time on the
 * hardware clock.
 */


static int stmmac_set_time(struct ptp_clock_info *ptp,
			   const struct timespec64 *ts)
{
	struct stmmac_priv *priv =
	    container_of(ptp, struct stmmac_priv, ptp_clock_ops);
	unsigned long flags;

	spin_lock_irqsave(&priv->ptp_lock, flags);
	stmmac_init_systime(priv, priv->ptpaddr, ts->tv_sec, ts->tv_nsec);
	spin_unlock_irqrestore(&priv->ptp_lock, flags);

	return 0;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
71
93.42%
1
25.00%
Jose Abreu
3
3.95%
1
25.00%
Giuseppe Cavallaro
1
1.32%
1
25.00%
Richard Cochran
1
1.32%
1
25.00%
Total
76
100.00%
4
100.00%



static int stmmac_enable(struct ptp_clock_info *ptp,
			 struct ptp_clock_request *rq, int on)
{
	struct stmmac_priv *priv =
	    container_of(ptp, struct stmmac_priv, ptp_clock_ops);
	struct stmmac_pps_cfg *cfg;
	int ret = -EOPNOTSUPP;
	unsigned long flags;

	switch (rq->type) {
	case PTP_CLK_REQ_PEROUT:
		cfg = &priv->pps[rq->perout.index];

		cfg->start.tv_sec = rq->perout.start.sec;
		cfg->start.tv_nsec = rq->perout.start.nsec;
		cfg->period.tv_sec = rq->perout.period.sec;
		cfg->period.tv_nsec = rq->perout.period.nsec;

		spin_lock_irqsave(&priv->ptp_lock, flags);
		ret = stmmac_flex_pps_config(priv, priv->ioaddr,
					     rq->perout.index, cfg, on,
					     priv->sub_second_inc,
					     priv->systime_flags);
		spin_unlock_irqrestore(&priv->ptp_lock, flags);
		break;
	default:
		break;
	}

	return ret;
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Jose Abreu
163
88.11%
1
50.00%
Rayagond Kokatanur
22
11.89%
1
50.00%
Total
185
100.00%
2
100.00%

/* structure describing a PTP hardware clock */

static struct ptp_clock_info stmmac_ptp_clock_ops = {
	.owner = THIS_MODULE,
	.name = "stmmac_ptp_clock",
	.max_adj = 62500000,
	.n_alarm = 0,
	.n_ext_ts = 0,
	.n_per_out = 0, /* will be overwritten in stmmac_ptp_register */
	.n_pins = 0,
	.pps = 0,
	.adjfreq = stmmac_adjust_freq,
	.adjtime = stmmac_adjust_time,
	.gettime64 = stmmac_get_time,
	.settime64 = stmmac_set_time,
	.enable = stmmac_enable,
};

/**
 * stmmac_ptp_register
 * @priv: driver private structure
 * Description: this function will register the ptp clock driver
 * to kernel. It also does some house keeping work.
 */


void stmmac_ptp_register(struct stmmac_priv *priv)
{
	int i;

	for (i = 0; i < priv->dma_cap.pps_out_num; i++) {
		if (i >= STMMAC_PPS_MAX)
			break;
		priv->pps[i].available = true;
	}

	stmmac_ptp_clock_ops.n_per_out = priv->dma_cap.pps_out_num;

	spin_lock_init(&priv->ptp_lock);
	priv->ptp_clock_ops = stmmac_ptp_clock_ops;

	priv->ptp_clock = ptp_clock_register(&priv->ptp_clock_ops,
					     priv->device);
	if (IS_ERR(priv->ptp_clock)) {
		netdev_err(priv->dev, "ptp_clock_register failed\n");
		priv->ptp_clock = NULL;
	} else if (priv->ptp_clock)
		netdev_info(priv->dev, "registered PTP clock\n");
}

Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
62
46.97%
1
16.67%
Jose Abreu
50
37.88%
1
16.67%
Giuseppe Cavallaro
14
10.61%
2
33.33%
Dan Carpenter
4
3.03%
1
16.67%
Nico Pitre
2
1.52%
1
16.67%
Total
132
100.00%
6
100.00%

/**
 * stmmac_ptp_unregister
 * @priv: driver private structure
 * Description: this function will remove/unregister the ptp clock driver
 * from the kernel.
 */


void stmmac_ptp_unregister(struct stmmac_priv *priv)
{
	if (priv->ptp_clock) {
		ptp_clock_unregister(priv->ptp_clock);
		priv->ptp_clock = NULL;
		pr_debug("Removed PTP HW clock successfully on %s\n",
			 priv->dev->name);
	}
}
Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
36
85.71%
1
50.00%
Giuseppe Cavallaro
6
14.29%
1
50.00%
Total
42
100.00%
2
100.00%

Overall Contributors
Person
Tokens
Prop
Commits
CommitProp
Rayagond Kokatanur
587
67.63%
1
6.67%
Jose Abreu
229
26.38%
2
13.33%
Giuseppe Cavallaro
32
3.69%
5
33.33%
Richard Cochran
11
1.27%
3
20.00%
Dan Carpenter
4
0.46%
1
6.67%
Vince Bridgers
2
0.23%
1
6.67%
Nico Pitre
2
0.23%
1
6.67%
Corentin Labbe
1
0.12%
1
6.67%
Total
868
100.00%
15
100.00%
Directory: drivers/net/ethernet/stmicro/stmmac

Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.