Commit 9055a2f5 authored by Arnd Bergmann's avatar Arnd Bergmann Committed by David S. Miller

ixp4xx_eth: make ptp support a platform driver

After the recent ixp4xx cleanups, the ptp driver has gained a
build failure in some configurations:

drivers/net/ethernet/xscale/ptp_ixp46x.c: In function 'ptp_ixp_init':
drivers/net/ethernet/xscale/ptp_ixp46x.c:290:51: error: 'IXP4XX_TIMESYNC_BASE_VIRT' undeclared (first use in this function)

Avoid the last bit of hardcoded constants from platform headers
by turning the ptp driver bit into a platform driver and passing
the IRQ and MMIO address as resources.

This is a bit tricky:

- The interface between the two drivers is now the new
  ixp46x_ptp_find() function, replacing the global
  ixp46x_phc_index variable. The call is done as late
  as possible, in hwtstamp_set(), to ensure that the
  ptp device is fully probed.

- As the ptp driver is now called by the network driver, the
  link dependency is reversed, which in turn requires a small
  Makefile hack

- The GPIO number is still left hardcoded. This is clearly not
  great, but it can be addressed later. Note that commit 98ac0cc2
  ("ARM: ixp4xx: Convert to MULTI_IRQ_HANDLER") changed the
  IRQ number to something meaningless. Passing the correct IRQ
  in a resource fixes this.

- When the PTP driver is disabled, ethtool .get_ts_info()
  now correctly lists only software timestamping regardless
  of the hardware.
Signed-off-by: default avatarArnd Bergmann <arnd@arndb.de>
[Fix a missing include]
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 27c77943
...@@ -268,9 +268,23 @@ static struct platform_device ixp46x_i2c_controller = { ...@@ -268,9 +268,23 @@ static struct platform_device ixp46x_i2c_controller = {
.resource = ixp46x_i2c_resources .resource = ixp46x_i2c_resources
}; };
static struct resource ixp46x_ptp_resources[] = {
DEFINE_RES_MEM(IXP4XX_TIMESYNC_BASE_PHYS, SZ_4K),
DEFINE_RES_IRQ_NAMED(IRQ_IXP4XX_GPIO8, "master"),
DEFINE_RES_IRQ_NAMED(IRQ_IXP4XX_GPIO7, "slave"),
};
static struct platform_device ixp46x_ptp = {
.name = "ptp-ixp46x",
.id = -1,
.resource = ixp46x_ptp_resources,
.num_resources = ARRAY_SIZE(ixp46x_ptp_resources),
};
static struct platform_device *ixp46x_devices[] __initdata = { static struct platform_device *ixp46x_devices[] __initdata = {
&ixp46x_hwrandom_device, &ixp46x_hwrandom_device,
&ixp46x_i2c_controller, &ixp46x_i2c_controller,
&ixp46x_ptp,
}; };
unsigned long ixp4xx_exp_bus_size; unsigned long ixp4xx_exp_bus_size;
......
...@@ -29,9 +29,9 @@ config IXP4XX_ETH ...@@ -29,9 +29,9 @@ config IXP4XX_ETH
on IXP4xx processor. on IXP4xx processor.
config PTP_1588_CLOCK_IXP46X config PTP_1588_CLOCK_IXP46X
tristate "Intel IXP46x as PTP clock" bool "Intel IXP46x as PTP clock"
depends on IXP4XX_ETH depends on IXP4XX_ETH
depends on PTP_1588_CLOCK depends on PTP_1588_CLOCK=y || PTP_1588_CLOCK=IXP4XX_ETH
default y default y
help help
This driver adds support for using the IXP46X as a PTP This driver adds support for using the IXP46X as a PTP
......
...@@ -3,5 +3,9 @@ ...@@ -3,5 +3,9 @@
# Makefile for the Intel XScale IXP device drivers. # Makefile for the Intel XScale IXP device drivers.
# #
# Keep this link order to avoid deferred probing
ifdef CONFIG_PTP_1588_CLOCK_IXP46X
obj-$(CONFIG_IXP4XX_ETH) += ptp_ixp46x.o
endif
obj-$(CONFIG_IXP4XX_ETH) += ixp4xx_eth.o obj-$(CONFIG_IXP4XX_ETH) += ixp4xx_eth.o
obj-$(CONFIG_PTP_1588_CLOCK_IXP46X) += ptp_ixp46x.o
...@@ -62,7 +62,16 @@ struct ixp46x_ts_regs { ...@@ -62,7 +62,16 @@ struct ixp46x_ts_regs {
#define TX_SNAPSHOT_LOCKED (1<<0) #define TX_SNAPSHOT_LOCKED (1<<0)
#define RX_SNAPSHOT_LOCKED (1<<1) #define RX_SNAPSHOT_LOCKED (1<<1)
/* The ptp_ixp46x module will set this variable */ #if IS_ENABLED(CONFIG_PTP_1588_CLOCK_IXP46X)
extern int ixp46x_phc_index; int ixp46x_ptp_find(struct ixp46x_ts_regs *__iomem *regs, int *phc_index);
#else
static inline int ixp46x_ptp_find(struct ixp46x_ts_regs *__iomem *regs, int *phc_index)
{
*regs = NULL;
*phc_index = -1;
return -ENODEV;
}
#endif
#endif #endif
...@@ -169,6 +169,8 @@ struct eth_regs { ...@@ -169,6 +169,8 @@ struct eth_regs {
struct port { struct port {
struct eth_regs __iomem *regs; struct eth_regs __iomem *regs;
struct ixp46x_ts_regs __iomem *timesync_regs;
int phc_index;
struct npe *npe; struct npe *npe;
struct net_device *netdev; struct net_device *netdev;
struct napi_struct napi; struct napi_struct napi;
...@@ -295,7 +297,7 @@ static void ixp_rx_timestamp(struct port *port, struct sk_buff *skb) ...@@ -295,7 +297,7 @@ static void ixp_rx_timestamp(struct port *port, struct sk_buff *skb)
ch = PORT2CHANNEL(port); ch = PORT2CHANNEL(port);
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT; regs = port->timesync_regs;
val = __raw_readl(&regs->channel[ch].ch_event); val = __raw_readl(&regs->channel[ch].ch_event);
...@@ -340,7 +342,7 @@ static void ixp_tx_timestamp(struct port *port, struct sk_buff *skb) ...@@ -340,7 +342,7 @@ static void ixp_tx_timestamp(struct port *port, struct sk_buff *skb)
ch = PORT2CHANNEL(port); ch = PORT2CHANNEL(port);
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT; regs = port->timesync_regs;
/* /*
* This really stinks, but we have to poll for the Tx time stamp. * This really stinks, but we have to poll for the Tx time stamp.
...@@ -375,6 +377,7 @@ static int hwtstamp_set(struct net_device *netdev, struct ifreq *ifr) ...@@ -375,6 +377,7 @@ static int hwtstamp_set(struct net_device *netdev, struct ifreq *ifr)
struct hwtstamp_config cfg; struct hwtstamp_config cfg;
struct ixp46x_ts_regs *regs; struct ixp46x_ts_regs *regs;
struct port *port = netdev_priv(netdev); struct port *port = netdev_priv(netdev);
int ret;
int ch; int ch;
if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg))) if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
...@@ -383,8 +386,12 @@ static int hwtstamp_set(struct net_device *netdev, struct ifreq *ifr) ...@@ -383,8 +386,12 @@ static int hwtstamp_set(struct net_device *netdev, struct ifreq *ifr)
if (cfg.flags) /* reserved for future extensions */ if (cfg.flags) /* reserved for future extensions */
return -EINVAL; return -EINVAL;
ret = ixp46x_ptp_find(&port->timesync_regs, &port->phc_index);
if (ret)
return ret;
ch = PORT2CHANNEL(port); ch = PORT2CHANNEL(port);
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT; regs = port->timesync_regs;
if (cfg.tx_type != HWTSTAMP_TX_OFF && cfg.tx_type != HWTSTAMP_TX_ON) if (cfg.tx_type != HWTSTAMP_TX_OFF && cfg.tx_type != HWTSTAMP_TX_ON)
return -ERANGE; return -ERANGE;
...@@ -988,25 +995,27 @@ static void ixp4xx_get_drvinfo(struct net_device *dev, ...@@ -988,25 +995,27 @@ static void ixp4xx_get_drvinfo(struct net_device *dev,
strlcpy(info->bus_info, "internal", sizeof(info->bus_info)); strlcpy(info->bus_info, "internal", sizeof(info->bus_info));
} }
int ixp46x_phc_index = -1;
EXPORT_SYMBOL_GPL(ixp46x_phc_index);
static int ixp4xx_get_ts_info(struct net_device *dev, static int ixp4xx_get_ts_info(struct net_device *dev,
struct ethtool_ts_info *info) struct ethtool_ts_info *info)
{ {
if (!cpu_is_ixp46x()) { struct port *port = netdev_priv(dev);
if (port->phc_index < 0)
ixp46x_ptp_find(&port->timesync_regs, &port->phc_index);
info->phc_index = port->phc_index;
if (info->phc_index < 0) {
info->so_timestamping = info->so_timestamping =
SOF_TIMESTAMPING_TX_SOFTWARE | SOF_TIMESTAMPING_TX_SOFTWARE |
SOF_TIMESTAMPING_RX_SOFTWARE | SOF_TIMESTAMPING_RX_SOFTWARE |
SOF_TIMESTAMPING_SOFTWARE; SOF_TIMESTAMPING_SOFTWARE;
info->phc_index = -1;
return 0; return 0;
} }
info->so_timestamping = info->so_timestamping =
SOF_TIMESTAMPING_TX_HARDWARE | SOF_TIMESTAMPING_TX_HARDWARE |
SOF_TIMESTAMPING_RX_HARDWARE | SOF_TIMESTAMPING_RX_HARDWARE |
SOF_TIMESTAMPING_RAW_HARDWARE; SOF_TIMESTAMPING_RAW_HARDWARE;
info->phc_index = ixp46x_phc_index;
info->tx_types = info->tx_types =
(1 << HWTSTAMP_TX_OFF) | (1 << HWTSTAMP_TX_OFF) |
(1 << HWTSTAMP_TX_ON); (1 << HWTSTAMP_TX_ON);
...@@ -1481,6 +1490,7 @@ static int ixp4xx_eth_probe(struct platform_device *pdev) ...@@ -1481,6 +1490,7 @@ static int ixp4xx_eth_probe(struct platform_device *pdev)
port = netdev_priv(ndev); port = netdev_priv(ndev);
port->netdev = ndev; port->netdev = ndev;
port->id = plat->npe; port->id = plat->npe;
port->phc_index = -1;
/* Get the port resource and remap */ /* Get the port resource and remap */
port->regs = devm_platform_get_and_ioremap_resource(pdev, 0, NULL); port->regs = devm_platform_get_and_ioremap_resource(pdev, 0, NULL);
......
...@@ -5,6 +5,7 @@ ...@@ -5,6 +5,7 @@
* Copyright (C) 2010 OMICRON electronics GmbH * Copyright (C) 2010 OMICRON electronics GmbH
*/ */
#include <linux/device.h> #include <linux/device.h>
#include <linux/module.h>
#include <linux/err.h> #include <linux/err.h>
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/init.h> #include <linux/init.h>
...@@ -13,6 +14,7 @@ ...@@ -13,6 +14,7 @@
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/ptp_clock_kernel.h> #include <linux/ptp_clock_kernel.h>
#include <linux/platform_device.h>
#include <linux/soc/ixp4xx/cpu.h> #include <linux/soc/ixp4xx/cpu.h>
#include <linux/module.h> #include <linux/module.h>
#include <mach/ixp4xx-regs.h> #include <mach/ixp4xx-regs.h>
...@@ -22,9 +24,7 @@ ...@@ -22,9 +24,7 @@
#define DRIVER "ptp_ixp46x" #define DRIVER "ptp_ixp46x"
#define N_EXT_TS 2 #define N_EXT_TS 2
#define MASTER_GPIO 8 #define MASTER_GPIO 8
#define MASTER_IRQ 25
#define SLAVE_GPIO 7 #define SLAVE_GPIO 7
#define SLAVE_IRQ 24
struct ixp_clock { struct ixp_clock {
struct ixp46x_ts_regs *regs; struct ixp46x_ts_regs *regs;
...@@ -32,9 +32,11 @@ struct ixp_clock { ...@@ -32,9 +32,11 @@ struct ixp_clock {
struct ptp_clock_info caps; struct ptp_clock_info caps;
int exts0_enabled; int exts0_enabled;
int exts1_enabled; int exts1_enabled;
int slave_irq;
int master_irq;
}; };
DEFINE_SPINLOCK(register_lock); static DEFINE_SPINLOCK(register_lock);
/* /*
* Register access functions * Register access functions
...@@ -275,21 +277,36 @@ static int setup_interrupt(int gpio) ...@@ -275,21 +277,36 @@ static int setup_interrupt(int gpio)
return irq; return irq;
} }
static void __exit ptp_ixp_exit(void) int ixp46x_ptp_find(struct ixp46x_ts_regs *__iomem *regs, int *phc_index)
{ {
free_irq(MASTER_IRQ, &ixp_clock); *regs = ixp_clock.regs;
free_irq(SLAVE_IRQ, &ixp_clock); *phc_index = ptp_clock_index(ixp_clock.ptp_clock);
ixp46x_phc_index = -1;
ptp_clock_unregister(ixp_clock.ptp_clock); if (!ixp_clock.ptp_clock)
return -EPROBE_DEFER;
return 0;
} }
EXPORT_SYMBOL_GPL(ixp46x_ptp_find);
static int __init ptp_ixp_init(void) static int ptp_ixp_remove(struct platform_device *pdev)
{ {
if (!cpu_is_ixp46x()) free_irq(ixp_clock.master_irq, &ixp_clock);
return -ENODEV; free_irq(ixp_clock.slave_irq, &ixp_clock);
ptp_clock_unregister(ixp_clock.ptp_clock);
ixp_clock.ptp_clock = NULL;
ixp_clock.regs = return 0;
(struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT; }
static int ptp_ixp_probe(struct platform_device *pdev)
{
ixp_clock.regs = devm_platform_ioremap_resource(pdev, 0);
ixp_clock.master_irq = platform_get_irq(pdev, 0);
ixp_clock.slave_irq = platform_get_irq(pdev, 1);
if (IS_ERR(ixp_clock.regs) ||
!ixp_clock.master_irq || !ixp_clock.slave_irq)
return -ENXIO;
ixp_clock.caps = ptp_ixp_caps; ixp_clock.caps = ptp_ixp_caps;
...@@ -298,32 +315,36 @@ static int __init ptp_ixp_init(void) ...@@ -298,32 +315,36 @@ static int __init ptp_ixp_init(void)
if (IS_ERR(ixp_clock.ptp_clock)) if (IS_ERR(ixp_clock.ptp_clock))
return PTR_ERR(ixp_clock.ptp_clock); return PTR_ERR(ixp_clock.ptp_clock);
ixp46x_phc_index = ptp_clock_index(ixp_clock.ptp_clock);
__raw_writel(DEFAULT_ADDEND, &ixp_clock.regs->addend); __raw_writel(DEFAULT_ADDEND, &ixp_clock.regs->addend);
__raw_writel(1, &ixp_clock.regs->trgt_lo); __raw_writel(1, &ixp_clock.regs->trgt_lo);
__raw_writel(0, &ixp_clock.regs->trgt_hi); __raw_writel(0, &ixp_clock.regs->trgt_hi);
__raw_writel(TTIPEND, &ixp_clock.regs->event); __raw_writel(TTIPEND, &ixp_clock.regs->event);
if (MASTER_IRQ != setup_interrupt(MASTER_GPIO)) { if (ixp_clock.master_irq != setup_interrupt(MASTER_GPIO)) {
pr_err("failed to setup gpio %d as irq\n", MASTER_GPIO); pr_err("failed to setup gpio %d as irq\n", MASTER_GPIO);
goto no_master; goto no_master;
} }
if (SLAVE_IRQ != setup_interrupt(SLAVE_GPIO)) { if (ixp_clock.slave_irq != setup_interrupt(SLAVE_GPIO)) {
pr_err("failed to setup gpio %d as irq\n", SLAVE_GPIO); pr_err("failed to setup gpio %d as irq\n", SLAVE_GPIO);
goto no_slave; goto no_slave;
} }
return 0; return 0;
no_slave: no_slave:
free_irq(MASTER_IRQ, &ixp_clock); free_irq(ixp_clock.master_irq, &ixp_clock);
no_master: no_master:
ptp_clock_unregister(ixp_clock.ptp_clock); ptp_clock_unregister(ixp_clock.ptp_clock);
ixp_clock.ptp_clock = NULL;
return -ENODEV; return -ENODEV;
} }
module_init(ptp_ixp_init); static struct platform_driver ptp_ixp_driver = {
module_exit(ptp_ixp_exit); .driver.name = "ptp-ixp46x",
.driver.suppress_bind_attrs = true,
.probe = ptp_ixp_probe,
.remove = ptp_ixp_remove,
};
module_platform_driver(ptp_ixp_driver);
MODULE_AUTHOR("Richard Cochran <richardcochran@gmail.com>"); MODULE_AUTHOR("Richard Cochran <richardcochran@gmail.com>");
MODULE_DESCRIPTION("PTP clock using the IXP46X timer"); MODULE_DESCRIPTION("PTP clock using the IXP46X timer");
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment