Skip to content

Commit

Permalink
ptp_qoriq: convert to use ptp_qoriq_init/free
Browse files Browse the repository at this point in the history 
Moved QorIQ PTP clock initialization/free into new functions
ptp_qoriq_init()/ptp_qoriq_free(). These functions could also
be reused by ENETC PTP drvier which is a PCI driver for same
1588 timer IP block.

Signed-off-by: Yangbo Lu <[email protected]>
Signed-off-by: David S. Miller <[email protected]>
  • Loading branch information
@yangbolu1991 @davem330
yangbolu1991 authored and davem330 committed Feb 12, 2019
1 parent 73356e4 commit ff54571
Show file tree
Hide file tree
Showing 2 changed files with 80 additions and 67 deletions.
144 changes: 77 additions & 67 deletions drivers/ptp/ptp_qoriq.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -458,25 +458,17 @@ static int ptp_qoriq_auto_config(struct ptp_qoriq *ptp_qoriq,
return 0;
}

static int ptp_qoriq_probe(struct platform_device *dev)
int ptp_qoriq_init(struct ptp_qoriq *ptp_qoriq, void __iomem *base,
const struct ptp_clock_info caps)
{
struct device_node *node = dev->dev.of_node;
struct ptp_qoriq *ptp_qoriq;
struct device_node *node = ptp_qoriq->dev->of_node;
struct ptp_qoriq_registers *regs;
struct timespec64 now;
int err = -ENOMEM;
u32 tmr_ctrl;
unsigned long flags;
void __iomem *base;

ptp_qoriq = kzalloc(sizeof(*ptp_qoriq), GFP_KERNEL);
if (!ptp_qoriq)
goto no_memory;

err = -EINVAL;
u32 tmr_ctrl;

ptp_qoriq->dev = &dev->dev;
ptp_qoriq->caps = ptp_qoriq_caps;
ptp_qoriq->base = base;
ptp_qoriq->caps = caps;

if (of_property_read_u32(node, "fsl,cksel", &ptp_qoriq->cksel))
ptp_qoriq->cksel = DEFAULT_CKSEL;
Expand All @@ -501,44 +493,9 @@ static int ptp_qoriq_probe(struct platform_device *dev)
pr_warn("device tree node missing required elements, try automatic configuration\n");

if (ptp_qoriq_auto_config(ptp_qoriq, node))
goto no_config;
return -ENODEV;
}

err = -ENODEV;

ptp_qoriq->irq = platform_get_irq(dev, 0);

if (ptp_qoriq->irq < 0) {
pr_err("irq not in device tree\n");
goto no_node;
}
if (request_irq(ptp_qoriq->irq, ptp_qoriq_isr, IRQF_SHARED,
DRIVER, ptp_qoriq)) {
pr_err("request_irq failed\n");
goto no_node;
}

ptp_qoriq->rsrc = platform_get_resource(dev, IORESOURCE_MEM, 0);
if (!ptp_qoriq->rsrc) {
pr_err("no resource\n");
goto no_resource;
}
if (request_resource(&iomem_resource, ptp_qoriq->rsrc)) {
pr_err("resource busy\n");
goto no_resource;
}

spin_lock_init(&ptp_qoriq->lock);

base = ioremap(ptp_qoriq->rsrc->start,
resource_size(ptp_qoriq->rsrc));
if (!base) {
pr_err("ioremap ptp registers failed\n");
goto no_ioremap;
}

ptp_qoriq->base = base;

if (of_device_is_compatible(node, "fsl,fman-ptp-timer")) {
ptp_qoriq->regs.ctrl_regs = base + FMAN_CTRL_REGS_OFFSET;
ptp_qoriq->regs.alarm_regs = base + FMAN_ALARM_REGS_OFFSET;
Expand All @@ -558,6 +515,7 @@ static int ptp_qoriq_probe(struct platform_device *dev)
(ptp_qoriq->tclk_period & TCLK_PERIOD_MASK) << TCLK_PERIOD_SHIFT |
(ptp_qoriq->cksel & CKSEL_MASK) << CKSEL_SHIFT;

spin_lock_init(&ptp_qoriq->lock);
spin_lock_irqsave(&ptp_qoriq->lock, flags);

regs = &ptp_qoriq->regs;
Expand All @@ -571,16 +529,77 @@ static int ptp_qoriq_probe(struct platform_device *dev)

spin_unlock_irqrestore(&ptp_qoriq->lock, flags);

ptp_qoriq->clock = ptp_clock_register(&ptp_qoriq->caps, &dev->dev);
if (IS_ERR(ptp_qoriq->clock)) {
err = PTR_ERR(ptp_qoriq->clock);
goto no_clock;
}
ptp_qoriq->phc_index = ptp_clock_index(ptp_qoriq->clock);
ptp_qoriq->clock = ptp_clock_register(&ptp_qoriq->caps, ptp_qoriq->dev);
if (IS_ERR(ptp_qoriq->clock))
return PTR_ERR(ptp_qoriq->clock);

ptp_qoriq->phc_index = ptp_clock_index(ptp_qoriq->clock);
ptp_qoriq_create_debugfs(ptp_qoriq);
platform_set_drvdata(dev, ptp_qoriq);
return 0;
}
EXPORT_SYMBOL_GPL(ptp_qoriq_init);

void ptp_qoriq_free(struct ptp_qoriq *ptp_qoriq)
{
struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

qoriq_write(&regs->ctrl_regs->tmr_temask, 0);
qoriq_write(&regs->ctrl_regs->tmr_ctrl, 0);

ptp_qoriq_remove_debugfs(ptp_qoriq);
ptp_clock_unregister(ptp_qoriq->clock);
iounmap(ptp_qoriq->base);
free_irq(ptp_qoriq->irq, ptp_qoriq);
}
EXPORT_SYMBOL_GPL(ptp_qoriq_free);

static int ptp_qoriq_probe(struct platform_device *dev)
{
struct ptp_qoriq *ptp_qoriq;
int err = -ENOMEM;
void __iomem *base;

ptp_qoriq = kzalloc(sizeof(*ptp_qoriq), GFP_KERNEL);
if (!ptp_qoriq)
goto no_memory;

ptp_qoriq->dev = &dev->dev;

err = -ENODEV;

ptp_qoriq->irq = platform_get_irq(dev, 0);
if (ptp_qoriq->irq < 0) {
pr_err("irq not in device tree\n");
goto no_node;
}
if (request_irq(ptp_qoriq->irq, ptp_qoriq_isr, IRQF_SHARED,
DRIVER, ptp_qoriq)) {
pr_err("request_irq failed\n");
goto no_node;
}

ptp_qoriq->rsrc = platform_get_resource(dev, IORESOURCE_MEM, 0);
if (!ptp_qoriq->rsrc) {
pr_err("no resource\n");
goto no_resource;
}
if (request_resource(&iomem_resource, ptp_qoriq->rsrc)) {
pr_err("resource busy\n");
goto no_resource;
}

base = ioremap(ptp_qoriq->rsrc->start,
resource_size(ptp_qoriq->rsrc));
if (!base) {
pr_err("ioremap ptp registers failed\n");
goto no_ioremap;
}

err = ptp_qoriq_init(ptp_qoriq, base, ptp_qoriq_caps);
if (err)
goto no_clock;

platform_set_drvdata(dev, ptp_qoriq);
return 0;

no_clock:
Expand All @@ -589,7 +608,6 @@ static int ptp_qoriq_probe(struct platform_device *dev)
release_resource(ptp_qoriq->rsrc);
no_resource:
free_irq(ptp_qoriq->irq, ptp_qoriq);
no_config:
no_node:
kfree(ptp_qoriq);
no_memory:
Expand All @@ -599,18 +617,10 @@ static int ptp_qoriq_probe(struct platform_device *dev)
static int ptp_qoriq_remove(struct platform_device *dev)
{
struct ptp_qoriq *ptp_qoriq = platform_get_drvdata(dev);
struct ptp_qoriq_registers *regs = &ptp_qoriq->regs;

qoriq_write(&regs->ctrl_regs->tmr_temask, 0);
qoriq_write(&regs->ctrl_regs->tmr_ctrl, 0);

ptp_qoriq_remove_debugfs(ptp_qoriq);
ptp_clock_unregister(ptp_qoriq->clock);
iounmap(ptp_qoriq->base);
ptp_qoriq_free(ptp_qoriq);
release_resource(ptp_qoriq->rsrc);
free_irq(ptp_qoriq->irq, ptp_qoriq);
kfree(ptp_qoriq);

return 0;
}

Expand Down
3 changes: 3 additions & 0 deletions include/linux/fsl/ptp_qoriq.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -173,6 +173,9 @@ static inline void qoriq_write(unsigned __iomem *addr, u32 val)
}

irqreturn_t ptp_qoriq_isr(int irq, void *priv);
int ptp_qoriq_init(struct ptp_qoriq *ptp_qoriq, void __iomem *base,
const struct ptp_clock_info caps);
void ptp_qoriq_free(struct ptp_qoriq *ptp_qoriq);
int ptp_qoriq_adjfine(struct ptp_clock_info *ptp, long scaled_ppm);
int ptp_qoriq_adjtime(struct ptp_clock_info *ptp, s64 delta);
int ptp_qoriq_gettime(struct ptp_clock_info *ptp, struct timespec64 *ts);
Expand Down

0 comments on commit ff54571

Please sign in to comment.