1 // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
2 /* Copyright 2019 NXP */
3 
4 #include <linux/module.h>
5 #include <linux/of.h>
6 #include <linux/fsl/ptp_qoriq.h>
7 
8 #include "enetc.h"
9 
10 int enetc_phc_index = -1;
11 EXPORT_SYMBOL_GPL(enetc_phc_index);
12 
13 static struct ptp_clock_info enetc_ptp_caps = {
14 	.owner		= THIS_MODULE,
15 	.name		= "ENETC PTP clock",
16 	.max_adj	= 512000,
17 	.n_alarm	= 0,
18 	.n_ext_ts	= 2,
19 	.n_per_out	= 0,
20 	.n_pins		= 0,
21 	.pps		= 1,
22 	.adjfine	= ptp_qoriq_adjfine,
23 	.adjtime	= ptp_qoriq_adjtime,
24 	.gettime64	= ptp_qoriq_gettime,
25 	.settime64	= ptp_qoriq_settime,
26 	.enable		= ptp_qoriq_enable,
27 };
28 
enetc_ptp_probe(struct pci_dev * pdev,const struct pci_device_id * ent)29 static int enetc_ptp_probe(struct pci_dev *pdev,
30 			   const struct pci_device_id *ent)
31 {
32 	struct ptp_qoriq *ptp_qoriq;
33 	void __iomem *base;
34 	int err, len, n;
35 
36 	if (pdev->dev.of_node && !of_device_is_available(pdev->dev.of_node)) {
37 		dev_info(&pdev->dev, "device is disabled, skipping\n");
38 		return -ENODEV;
39 	}
40 
41 	err = pci_enable_device_mem(pdev);
42 	if (err)
43 		return dev_err_probe(&pdev->dev, err, "device enable failed\n");
44 
45 	err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
46 	if (err) {
47 		dev_err(&pdev->dev, "DMA configuration failed: 0x%x\n", err);
48 		goto err_dma;
49 	}
50 
51 	err = pci_request_mem_regions(pdev, KBUILD_MODNAME);
52 	if (err) {
53 		dev_err(&pdev->dev, "pci_request_regions failed err=%d\n", err);
54 		goto err_pci_mem_reg;
55 	}
56 
57 	pci_set_master(pdev);
58 
59 	ptp_qoriq = kzalloc(sizeof(*ptp_qoriq), GFP_KERNEL);
60 	if (!ptp_qoriq) {
61 		err = -ENOMEM;
62 		goto err_alloc_ptp;
63 	}
64 
65 	len = pci_resource_len(pdev, ENETC_BAR_REGS);
66 
67 	base = ioremap(pci_resource_start(pdev, ENETC_BAR_REGS), len);
68 	if (!base) {
69 		err = -ENXIO;
70 		dev_err(&pdev->dev, "ioremap() failed\n");
71 		goto err_ioremap;
72 	}
73 
74 	/* Allocate 1 interrupt */
75 	n = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSIX);
76 	if (n != 1) {
77 		err = -EPERM;
78 		goto err_irq_vectors;
79 	}
80 
81 	ptp_qoriq->irq = pci_irq_vector(pdev, 0);
82 
83 	err = request_irq(ptp_qoriq->irq, ptp_qoriq_isr, 0, DRIVER, ptp_qoriq);
84 	if (err) {
85 		dev_err(&pdev->dev, "request_irq() failed!\n");
86 		goto err_irq;
87 	}
88 
89 	ptp_qoriq->dev = &pdev->dev;
90 
91 	err = ptp_qoriq_init(ptp_qoriq, base, &enetc_ptp_caps);
92 	if (err)
93 		goto err_no_clock;
94 
95 	enetc_phc_index = ptp_qoriq->phc_index;
96 	pci_set_drvdata(pdev, ptp_qoriq);
97 
98 	return 0;
99 
100 err_no_clock:
101 	free_irq(ptp_qoriq->irq, ptp_qoriq);
102 err_irq:
103 	pci_free_irq_vectors(pdev);
104 err_irq_vectors:
105 	iounmap(base);
106 err_ioremap:
107 	kfree(ptp_qoriq);
108 err_alloc_ptp:
109 	pci_release_mem_regions(pdev);
110 err_pci_mem_reg:
111 err_dma:
112 	pci_disable_device(pdev);
113 
114 	return err;
115 }
116 
enetc_ptp_remove(struct pci_dev * pdev)117 static void enetc_ptp_remove(struct pci_dev *pdev)
118 {
119 	struct ptp_qoriq *ptp_qoriq = pci_get_drvdata(pdev);
120 
121 	enetc_phc_index = -1;
122 	ptp_qoriq_free(ptp_qoriq);
123 	pci_free_irq_vectors(pdev);
124 	kfree(ptp_qoriq);
125 
126 	pci_release_mem_regions(pdev);
127 	pci_disable_device(pdev);
128 }
129 
130 static const struct pci_device_id enetc_ptp_id_table[] = {
131 	{ PCI_DEVICE(PCI_VENDOR_ID_FREESCALE, ENETC_DEV_ID_PTP) },
132 	{ 0, } /* End of table. */
133 };
134 MODULE_DEVICE_TABLE(pci, enetc_ptp_id_table);
135 
136 static struct pci_driver enetc_ptp_driver = {
137 	.name = KBUILD_MODNAME,
138 	.id_table = enetc_ptp_id_table,
139 	.probe = enetc_ptp_probe,
140 	.remove = enetc_ptp_remove,
141 };
142 module_pci_driver(enetc_ptp_driver);
143 
144 MODULE_DESCRIPTION("ENETC PTP clock driver");
145 MODULE_LICENSE("Dual BSD/GPL");
146