152 lines
3.9 KiB
C
152 lines
3.9 KiB
C
/*******************************************************************************
|
|
Copyright (C) 2013 Vayavya Labs Pvt Ltd
|
|
|
|
This implements all the API for managing HW timestamp & PTP.
|
|
|
|
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.
|
|
|
|
You should have received a copy of the GNU General Public License along with
|
|
this program; if not, write to the Free Software Foundation, Inc.,
|
|
51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
|
|
|
|
The full GNU General Public License is included in this distribution in
|
|
the file called "COPYING".
|
|
|
|
Author: Rayagond Kokatanur <rayagond@vayavyalabs.com>
|
|
Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
|
|
*******************************************************************************/
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/delay.h>
|
|
#include "common.h"
|
|
#include "stmmac_ptp.h"
|
|
|
|
static void stmmac_config_hw_tstamping(void __iomem *ioaddr, u32 data)
|
|
{
|
|
writel(data, ioaddr + PTP_TCR);
|
|
}
|
|
|
|
static u32 stmmac_config_sub_second_increment(void __iomem *ioaddr,
|
|
u32 ptp_clock)
|
|
{
|
|
u32 value = readl(ioaddr + PTP_TCR);
|
|
unsigned long data;
|
|
|
|
/* Convert the ptp_clock to nano second
|
|
* formula = (2/ptp_clock) * 1000000000
|
|
* where, ptp_clock = 50MHz.
|
|
*/
|
|
data = (2000000000ULL / ptp_clock);
|
|
|
|
/* 0.465ns accuracy */
|
|
if (!(value & PTP_TCR_TSCTRLSSR))
|
|
data = (data * 1000) / 465;
|
|
|
|
writel(data, ioaddr + PTP_SSIR);
|
|
|
|
return data;
|
|
}
|
|
|
|
static int stmmac_init_systime(void __iomem *ioaddr, u32 sec, u32 nsec)
|
|
{
|
|
int limit;
|
|
u32 value;
|
|
|
|
writel(sec, ioaddr + PTP_STSUR);
|
|
writel(nsec, ioaddr + PTP_STNSUR);
|
|
/* issue command to initialize the system time value */
|
|
value = readl(ioaddr + PTP_TCR);
|
|
value |= PTP_TCR_TSINIT;
|
|
writel(value, ioaddr + PTP_TCR);
|
|
|
|
/* wait for present system time initialize to complete */
|
|
limit = 10;
|
|
while (limit--) {
|
|
if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSINIT))
|
|
break;
|
|
mdelay(10);
|
|
}
|
|
if (limit < 0)
|
|
return -EBUSY;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int stmmac_config_addend(void __iomem *ioaddr, u32 addend)
|
|
{
|
|
u32 value;
|
|
int limit;
|
|
|
|
writel(addend, ioaddr + PTP_TAR);
|
|
/* issue command to update the addend value */
|
|
value = readl(ioaddr + PTP_TCR);
|
|
value |= PTP_TCR_TSADDREG;
|
|
writel(value, ioaddr + PTP_TCR);
|
|
|
|
/* wait for present addend update to complete */
|
|
limit = 10;
|
|
while (limit--) {
|
|
if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSADDREG))
|
|
break;
|
|
mdelay(10);
|
|
}
|
|
if (limit < 0)
|
|
return -EBUSY;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int stmmac_adjust_systime(void __iomem *ioaddr, u32 sec, u32 nsec,
|
|
int add_sub)
|
|
{
|
|
u32 value;
|
|
int limit;
|
|
|
|
writel(sec, ioaddr + PTP_STSUR);
|
|
writel(((add_sub << PTP_STNSUR_ADDSUB_SHIFT) | nsec),
|
|
ioaddr + PTP_STNSUR);
|
|
/* issue command to initialize the system time value */
|
|
value = readl(ioaddr + PTP_TCR);
|
|
value |= PTP_TCR_TSUPDT;
|
|
writel(value, ioaddr + PTP_TCR);
|
|
|
|
/* wait for present system time adjust/update to complete */
|
|
limit = 10;
|
|
while (limit--) {
|
|
if (!(readl(ioaddr + PTP_TCR) & PTP_TCR_TSUPDT))
|
|
break;
|
|
mdelay(10);
|
|
}
|
|
if (limit < 0)
|
|
return -EBUSY;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u64 stmmac_get_systime(void __iomem *ioaddr)
|
|
{
|
|
u64 ns;
|
|
|
|
ns = readl(ioaddr + PTP_STNSR);
|
|
/* convert sec time value to nanosecond */
|
|
ns += readl(ioaddr + PTP_STSR) * 1000000000ULL;
|
|
|
|
return ns;
|
|
}
|
|
|
|
const struct stmmac_hwtimestamp stmmac_ptp = {
|
|
.config_hw_tstamping = stmmac_config_hw_tstamping,
|
|
.init_systime = stmmac_init_systime,
|
|
.config_sub_second_increment = stmmac_config_sub_second_increment,
|
|
.config_addend = stmmac_config_addend,
|
|
.adjust_systime = stmmac_adjust_systime,
|
|
.get_systime = stmmac_get_systime,
|
|
};
|