xref: /openbmc/linux/drivers/ptp/ptp_ocp.c (revision bceff290)
1a7e1abadSJonathan Lemon // SPDX-License-Identifier: GPL-2.0-only
2a7e1abadSJonathan Lemon /* Copyright (c) 2020 Facebook */
3a7e1abadSJonathan Lemon 
4a7e1abadSJonathan Lemon #include <linux/err.h>
5a7e1abadSJonathan Lemon #include <linux/kernel.h>
6a7e1abadSJonathan Lemon #include <linux/module.h>
7a7e1abadSJonathan Lemon #include <linux/init.h>
8a7e1abadSJonathan Lemon #include <linux/pci.h>
9773bda96SJonathan Lemon #include <linux/serial_8250.h>
10773bda96SJonathan Lemon #include <linux/clkdev.h>
11773bda96SJonathan Lemon #include <linux/clk-provider.h>
12773bda96SJonathan Lemon #include <linux/platform_device.h>
13a7e1abadSJonathan Lemon #include <linux/ptp_clock_kernel.h>
14773bda96SJonathan Lemon #include <linux/spi/spi.h>
15773bda96SJonathan Lemon #include <linux/spi/xilinx_spi.h>
16773bda96SJonathan Lemon #include <net/devlink.h>
17773bda96SJonathan Lemon #include <linux/i2c.h>
18773bda96SJonathan Lemon #include <linux/mtd/mtd.h>
19a7e1abadSJonathan Lemon 
20773bda96SJonathan Lemon #ifndef PCI_VENDOR_ID_FACEBOOK
21773bda96SJonathan Lemon #define PCI_VENDOR_ID_FACEBOOK 0x1d9b
22773bda96SJonathan Lemon #endif
23773bda96SJonathan Lemon 
24773bda96SJonathan Lemon #ifndef PCI_DEVICE_ID_FACEBOOK_TIMECARD
25773bda96SJonathan Lemon #define PCI_DEVICE_ID_FACEBOOK_TIMECARD 0x0400
26773bda96SJonathan Lemon #endif
27773bda96SJonathan Lemon 
28773bda96SJonathan Lemon static struct class timecard_class = {
29773bda96SJonathan Lemon 	.owner		= THIS_MODULE,
30773bda96SJonathan Lemon 	.name		= "timecard",
31a7e1abadSJonathan Lemon };
32a7e1abadSJonathan Lemon 
33a7e1abadSJonathan Lemon struct ocp_reg {
34a7e1abadSJonathan Lemon 	u32	ctrl;
35a7e1abadSJonathan Lemon 	u32	status;
36a7e1abadSJonathan Lemon 	u32	select;
37a7e1abadSJonathan Lemon 	u32	version;
38a7e1abadSJonathan Lemon 	u32	time_ns;
39a7e1abadSJonathan Lemon 	u32	time_sec;
40a7e1abadSJonathan Lemon 	u32	__pad0[2];
41a7e1abadSJonathan Lemon 	u32	adjust_ns;
42a7e1abadSJonathan Lemon 	u32	adjust_sec;
43a7e1abadSJonathan Lemon 	u32	__pad1[2];
44a7e1abadSJonathan Lemon 	u32	offset_ns;
45a7e1abadSJonathan Lemon 	u32	offset_window_ns;
46773bda96SJonathan Lemon 	u32	__pad2[2];
47773bda96SJonathan Lemon 	u32	drift_ns;
48773bda96SJonathan Lemon 	u32	drift_window_ns;
49773bda96SJonathan Lemon 	u32	__pad3[6];
50773bda96SJonathan Lemon 	u32	servo_offset_p;
51773bda96SJonathan Lemon 	u32	servo_offset_i;
52773bda96SJonathan Lemon 	u32	servo_drift_p;
53773bda96SJonathan Lemon 	u32	servo_drift_i;
54a7e1abadSJonathan Lemon };
55a7e1abadSJonathan Lemon 
56a7e1abadSJonathan Lemon #define OCP_CTRL_ENABLE		BIT(0)
57a7e1abadSJonathan Lemon #define OCP_CTRL_ADJUST_TIME	BIT(1)
58a7e1abadSJonathan Lemon #define OCP_CTRL_ADJUST_OFFSET	BIT(2)
59773bda96SJonathan Lemon #define OCP_CTRL_ADJUST_DRIFT	BIT(3)
60773bda96SJonathan Lemon #define OCP_CTRL_ADJUST_SERVO	BIT(8)
61a7e1abadSJonathan Lemon #define OCP_CTRL_READ_TIME_REQ	BIT(30)
62a7e1abadSJonathan Lemon #define OCP_CTRL_READ_TIME_DONE	BIT(31)
63a7e1abadSJonathan Lemon 
64a7e1abadSJonathan Lemon #define OCP_STATUS_IN_SYNC	BIT(0)
65773bda96SJonathan Lemon #define OCP_STATUS_IN_HOLDOVER	BIT(1)
66a7e1abadSJonathan Lemon 
67a7e1abadSJonathan Lemon #define OCP_SELECT_CLK_NONE	0
68773bda96SJonathan Lemon #define OCP_SELECT_CLK_REG	0xfe
69a7e1abadSJonathan Lemon 
70a7e1abadSJonathan Lemon struct tod_reg {
71a7e1abadSJonathan Lemon 	u32	ctrl;
72a7e1abadSJonathan Lemon 	u32	status;
73a7e1abadSJonathan Lemon 	u32	uart_polarity;
74a7e1abadSJonathan Lemon 	u32	version;
75a7e1abadSJonathan Lemon 	u32	correction_sec;
76a7e1abadSJonathan Lemon 	u32	__pad0[3];
77a7e1abadSJonathan Lemon 	u32	uart_baud;
78a7e1abadSJonathan Lemon 	u32	__pad1[3];
79a7e1abadSJonathan Lemon 	u32	utc_status;
80a7e1abadSJonathan Lemon 	u32	leap;
81a7e1abadSJonathan Lemon };
82a7e1abadSJonathan Lemon 
83a7e1abadSJonathan Lemon #define TOD_CTRL_PROTOCOL	BIT(28)
84a7e1abadSJonathan Lemon #define TOD_CTRL_DISABLE_FMT_A	BIT(17)
85a7e1abadSJonathan Lemon #define TOD_CTRL_DISABLE_FMT_B	BIT(16)
86a7e1abadSJonathan Lemon #define TOD_CTRL_ENABLE		BIT(0)
87a7e1abadSJonathan Lemon #define TOD_CTRL_GNSS_MASK	((1U << 4) - 1)
88a7e1abadSJonathan Lemon #define TOD_CTRL_GNSS_SHIFT	24
89a7e1abadSJonathan Lemon 
90a7e1abadSJonathan Lemon #define TOD_STATUS_UTC_MASK	0xff
91a7e1abadSJonathan Lemon #define TOD_STATUS_UTC_VALID	BIT(8)
92a7e1abadSJonathan Lemon #define TOD_STATUS_LEAP_VALID	BIT(16)
93a7e1abadSJonathan Lemon 
94773bda96SJonathan Lemon struct ts_reg {
95773bda96SJonathan Lemon 	u32	enable;
96773bda96SJonathan Lemon 	u32	error;
97773bda96SJonathan Lemon 	u32	polarity;
98773bda96SJonathan Lemon 	u32	version;
99773bda96SJonathan Lemon 	u32	__pad0[4];
100773bda96SJonathan Lemon 	u32	cable_delay;
101773bda96SJonathan Lemon 	u32	__pad1[3];
102773bda96SJonathan Lemon 	u32	intr;
103773bda96SJonathan Lemon 	u32	intr_mask;
104773bda96SJonathan Lemon 	u32	event_count;
105773bda96SJonathan Lemon 	u32	__pad2[1];
106773bda96SJonathan Lemon 	u32	ts_count;
107773bda96SJonathan Lemon 	u32	time_ns;
108773bda96SJonathan Lemon 	u32	time_sec;
109773bda96SJonathan Lemon 	u32	data_width;
110773bda96SJonathan Lemon 	u32	data;
111773bda96SJonathan Lemon };
112773bda96SJonathan Lemon 
113773bda96SJonathan Lemon struct pps_reg {
114773bda96SJonathan Lemon 	u32	ctrl;
115773bda96SJonathan Lemon 	u32	status;
1160d43d4f2SJonathan Lemon 	u32	__pad0[6];
1170d43d4f2SJonathan Lemon 	u32	cable_delay;
118773bda96SJonathan Lemon };
119773bda96SJonathan Lemon 
120773bda96SJonathan Lemon #define PPS_STATUS_FILTER_ERR	BIT(0)
121773bda96SJonathan Lemon #define PPS_STATUS_SUPERV_ERR	BIT(1)
122773bda96SJonathan Lemon 
123773bda96SJonathan Lemon struct img_reg {
124773bda96SJonathan Lemon 	u32	version;
125773bda96SJonathan Lemon };
126773bda96SJonathan Lemon 
127773bda96SJonathan Lemon struct ptp_ocp_flash_info {
128773bda96SJonathan Lemon 	const char *name;
129773bda96SJonathan Lemon 	int pci_offset;
130773bda96SJonathan Lemon 	int data_size;
131773bda96SJonathan Lemon 	void *data;
132773bda96SJonathan Lemon };
133773bda96SJonathan Lemon 
1341618df6aSJonathan Lemon struct ptp_ocp_i2c_info {
1351618df6aSJonathan Lemon 	const char *name;
1361618df6aSJonathan Lemon 	unsigned long fixed_rate;
1371618df6aSJonathan Lemon 	size_t data_size;
1381618df6aSJonathan Lemon 	void *data;
1391618df6aSJonathan Lemon };
1401618df6aSJonathan Lemon 
141773bda96SJonathan Lemon struct ptp_ocp_ext_info {
142773bda96SJonathan Lemon 	int index;
143773bda96SJonathan Lemon 	irqreturn_t (*irq_fcn)(int irq, void *priv);
144773bda96SJonathan Lemon 	int (*enable)(void *priv, bool enable);
145773bda96SJonathan Lemon };
146773bda96SJonathan Lemon 
147773bda96SJonathan Lemon struct ptp_ocp_ext_src {
148773bda96SJonathan Lemon 	void __iomem		*mem;
149773bda96SJonathan Lemon 	struct ptp_ocp		*bp;
150773bda96SJonathan Lemon 	struct ptp_ocp_ext_info	*info;
151773bda96SJonathan Lemon 	int			irq_vec;
152773bda96SJonathan Lemon };
153773bda96SJonathan Lemon 
154a7e1abadSJonathan Lemon struct ptp_ocp {
155a7e1abadSJonathan Lemon 	struct pci_dev		*pdev;
156773bda96SJonathan Lemon 	struct device		dev;
157a7e1abadSJonathan Lemon 	spinlock_t		lock;
158a7e1abadSJonathan Lemon 	struct ocp_reg __iomem	*reg;
159a7e1abadSJonathan Lemon 	struct tod_reg __iomem	*tod;
1600d43d4f2SJonathan Lemon 	struct pps_reg __iomem	*pps_to_ext;
1610d43d4f2SJonathan Lemon 	struct pps_reg __iomem	*pps_to_clk;
162773bda96SJonathan Lemon 	struct ptp_ocp_ext_src	*pps;
163773bda96SJonathan Lemon 	struct ptp_ocp_ext_src	*ts0;
164773bda96SJonathan Lemon 	struct ptp_ocp_ext_src	*ts1;
165773bda96SJonathan Lemon 	struct img_reg __iomem	*image;
166a7e1abadSJonathan Lemon 	struct ptp_clock	*ptp;
167a7e1abadSJonathan Lemon 	struct ptp_clock_info	ptp_info;
168773bda96SJonathan Lemon 	struct platform_device	*i2c_ctrl;
169773bda96SJonathan Lemon 	struct platform_device	*spi_flash;
170773bda96SJonathan Lemon 	struct clk_hw		*i2c_clk;
171773bda96SJonathan Lemon 	struct timer_list	watchdog;
172ef0cfb34SJonathan Lemon 	time64_t		gnss_lost;
173773bda96SJonathan Lemon 	int			id;
174773bda96SJonathan Lemon 	int			n_irqs;
175ef0cfb34SJonathan Lemon 	int			gnss_port;
176773bda96SJonathan Lemon 	int			mac_port;	/* miniature atomic clock */
177773bda96SJonathan Lemon 	u8			serial[6];
178773bda96SJonathan Lemon 	int			flash_start;
179773bda96SJonathan Lemon 	bool			has_serial;
180a7e1abadSJonathan Lemon };
181a7e1abadSJonathan Lemon 
182773bda96SJonathan Lemon struct ocp_resource {
183773bda96SJonathan Lemon 	unsigned long offset;
184773bda96SJonathan Lemon 	int size;
185773bda96SJonathan Lemon 	int irq_vec;
186773bda96SJonathan Lemon 	int (*setup)(struct ptp_ocp *bp, struct ocp_resource *r);
187773bda96SJonathan Lemon 	void *extra;
188773bda96SJonathan Lemon 	unsigned long bp_offset;
18956ec4403SJonathan Lemon 	const char * const name;
190773bda96SJonathan Lemon };
191773bda96SJonathan Lemon 
192773bda96SJonathan Lemon static int ptp_ocp_register_mem(struct ptp_ocp *bp, struct ocp_resource *r);
193773bda96SJonathan Lemon static int ptp_ocp_register_i2c(struct ptp_ocp *bp, struct ocp_resource *r);
194773bda96SJonathan Lemon static int ptp_ocp_register_spi(struct ptp_ocp *bp, struct ocp_resource *r);
195773bda96SJonathan Lemon static int ptp_ocp_register_serial(struct ptp_ocp *bp, struct ocp_resource *r);
196773bda96SJonathan Lemon static int ptp_ocp_register_ext(struct ptp_ocp *bp, struct ocp_resource *r);
197773bda96SJonathan Lemon static int ptp_ocp_fb_board_init(struct ptp_ocp *bp, struct ocp_resource *r);
198773bda96SJonathan Lemon static irqreturn_t ptp_ocp_ts_irq(int irq, void *priv);
199773bda96SJonathan Lemon static int ptp_ocp_ts_enable(void *priv, bool enable);
200773bda96SJonathan Lemon 
201773bda96SJonathan Lemon #define bp_assign_entry(bp, res, val) ({				\
202773bda96SJonathan Lemon 	uintptr_t addr = (uintptr_t)(bp) + (res)->bp_offset;		\
203773bda96SJonathan Lemon 	*(typeof(val) *)addr = val;					\
204773bda96SJonathan Lemon })
205773bda96SJonathan Lemon 
206773bda96SJonathan Lemon #define OCP_RES_LOCATION(member) \
20756ec4403SJonathan Lemon 	.name = #member, .bp_offset = offsetof(struct ptp_ocp, member)
208773bda96SJonathan Lemon 
209773bda96SJonathan Lemon #define OCP_MEM_RESOURCE(member) \
210773bda96SJonathan Lemon 	OCP_RES_LOCATION(member), .setup = ptp_ocp_register_mem
211773bda96SJonathan Lemon 
212773bda96SJonathan Lemon #define OCP_SERIAL_RESOURCE(member) \
213773bda96SJonathan Lemon 	OCP_RES_LOCATION(member), .setup = ptp_ocp_register_serial
214773bda96SJonathan Lemon 
215773bda96SJonathan Lemon #define OCP_I2C_RESOURCE(member) \
216773bda96SJonathan Lemon 	OCP_RES_LOCATION(member), .setup = ptp_ocp_register_i2c
217773bda96SJonathan Lemon 
218773bda96SJonathan Lemon #define OCP_SPI_RESOURCE(member) \
219773bda96SJonathan Lemon 	OCP_RES_LOCATION(member), .setup = ptp_ocp_register_spi
220773bda96SJonathan Lemon 
221773bda96SJonathan Lemon #define OCP_EXT_RESOURCE(member) \
222773bda96SJonathan Lemon 	OCP_RES_LOCATION(member), .setup = ptp_ocp_register_ext
223773bda96SJonathan Lemon 
224773bda96SJonathan Lemon /* This is the MSI vector mapping used.
225773bda96SJonathan Lemon  * 0: N/C
226773bda96SJonathan Lemon  * 1: TS0
227773bda96SJonathan Lemon  * 2: TS1
228773bda96SJonathan Lemon  * 3: GPS
229773bda96SJonathan Lemon  * 4: GPS2 (n/c)
230773bda96SJonathan Lemon  * 5: MAC
2311447149dSJonathan Lemon  * 6: N/C
2321447149dSJonathan Lemon  * 7: I2C controller
233773bda96SJonathan Lemon  * 8: HWICAP
234773bda96SJonathan Lemon  * 9: SPI Flash
235773bda96SJonathan Lemon  */
236773bda96SJonathan Lemon 
237773bda96SJonathan Lemon static struct ocp_resource ocp_fb_resource[] = {
238773bda96SJonathan Lemon 	{
239773bda96SJonathan Lemon 		OCP_MEM_RESOURCE(reg),
240773bda96SJonathan Lemon 		.offset = 0x01000000, .size = 0x10000,
241773bda96SJonathan Lemon 	},
242773bda96SJonathan Lemon 	{
243773bda96SJonathan Lemon 		OCP_EXT_RESOURCE(ts0),
244773bda96SJonathan Lemon 		.offset = 0x01010000, .size = 0x10000, .irq_vec = 1,
245773bda96SJonathan Lemon 		.extra = &(struct ptp_ocp_ext_info) {
24656ec4403SJonathan Lemon 			.index = 0,
247773bda96SJonathan Lemon 			.irq_fcn = ptp_ocp_ts_irq,
248773bda96SJonathan Lemon 			.enable = ptp_ocp_ts_enable,
249773bda96SJonathan Lemon 		},
250773bda96SJonathan Lemon 	},
251773bda96SJonathan Lemon 	{
252773bda96SJonathan Lemon 		OCP_EXT_RESOURCE(ts1),
253773bda96SJonathan Lemon 		.offset = 0x01020000, .size = 0x10000, .irq_vec = 2,
254773bda96SJonathan Lemon 		.extra = &(struct ptp_ocp_ext_info) {
25556ec4403SJonathan Lemon 			.index = 1,
256773bda96SJonathan Lemon 			.irq_fcn = ptp_ocp_ts_irq,
257773bda96SJonathan Lemon 			.enable = ptp_ocp_ts_enable,
258773bda96SJonathan Lemon 		},
259773bda96SJonathan Lemon 	},
260773bda96SJonathan Lemon 	{
2610d43d4f2SJonathan Lemon 		OCP_MEM_RESOURCE(pps_to_ext),
2620d43d4f2SJonathan Lemon 		.offset = 0x01030000, .size = 0x10000,
2630d43d4f2SJonathan Lemon 	},
2640d43d4f2SJonathan Lemon 	{
2650d43d4f2SJonathan Lemon 		OCP_MEM_RESOURCE(pps_to_clk),
266773bda96SJonathan Lemon 		.offset = 0x01040000, .size = 0x10000,
267773bda96SJonathan Lemon 	},
268773bda96SJonathan Lemon 	{
269773bda96SJonathan Lemon 		OCP_MEM_RESOURCE(tod),
270773bda96SJonathan Lemon 		.offset = 0x01050000, .size = 0x10000,
271773bda96SJonathan Lemon 	},
272773bda96SJonathan Lemon 	{
273773bda96SJonathan Lemon 		OCP_MEM_RESOURCE(image),
274773bda96SJonathan Lemon 		.offset = 0x00020000, .size = 0x1000,
275773bda96SJonathan Lemon 	},
276773bda96SJonathan Lemon 	{
277773bda96SJonathan Lemon 		OCP_I2C_RESOURCE(i2c_ctrl),
278773bda96SJonathan Lemon 		.offset = 0x00150000, .size = 0x10000, .irq_vec = 7,
2791618df6aSJonathan Lemon 		.extra = &(struct ptp_ocp_i2c_info) {
2801618df6aSJonathan Lemon 			.name = "xiic-i2c",
2811618df6aSJonathan Lemon 			.fixed_rate = 50000000,
2821618df6aSJonathan Lemon 		},
283773bda96SJonathan Lemon 	},
284773bda96SJonathan Lemon 	{
285ef0cfb34SJonathan Lemon 		OCP_SERIAL_RESOURCE(gnss_port),
286773bda96SJonathan Lemon 		.offset = 0x00160000 + 0x1000, .irq_vec = 3,
287773bda96SJonathan Lemon 	},
288773bda96SJonathan Lemon 	{
289773bda96SJonathan Lemon 		OCP_SERIAL_RESOURCE(mac_port),
290773bda96SJonathan Lemon 		.offset = 0x00180000 + 0x1000, .irq_vec = 5,
291773bda96SJonathan Lemon 	},
292773bda96SJonathan Lemon 	{
293773bda96SJonathan Lemon 		OCP_SPI_RESOURCE(spi_flash),
294773bda96SJonathan Lemon 		.offset = 0x00310000, .size = 0x10000, .irq_vec = 9,
295773bda96SJonathan Lemon 		.extra = &(struct ptp_ocp_flash_info) {
296773bda96SJonathan Lemon 			.name = "xilinx_spi", .pci_offset = 0,
297773bda96SJonathan Lemon 			.data_size = sizeof(struct xspi_platform_data),
298773bda96SJonathan Lemon 			.data = &(struct xspi_platform_data) {
299773bda96SJonathan Lemon 				.num_chipselect = 1,
300773bda96SJonathan Lemon 				.bits_per_word = 8,
301773bda96SJonathan Lemon 				.num_devices = 1,
302773bda96SJonathan Lemon 				.devices = &(struct spi_board_info) {
303773bda96SJonathan Lemon 					.modalias = "spi-nor",
304773bda96SJonathan Lemon 				},
305773bda96SJonathan Lemon 			},
306773bda96SJonathan Lemon 		},
307773bda96SJonathan Lemon 	},
308773bda96SJonathan Lemon 	{
309773bda96SJonathan Lemon 		.setup = ptp_ocp_fb_board_init,
310773bda96SJonathan Lemon 	},
311773bda96SJonathan Lemon 	{ }
312773bda96SJonathan Lemon };
313773bda96SJonathan Lemon 
314773bda96SJonathan Lemon static const struct pci_device_id ptp_ocp_pcidev_id[] = {
315773bda96SJonathan Lemon 	{ PCI_DEVICE_DATA(FACEBOOK, TIMECARD, &ocp_fb_resource) },
316773bda96SJonathan Lemon 	{ 0 }
317773bda96SJonathan Lemon };
318773bda96SJonathan Lemon MODULE_DEVICE_TABLE(pci, ptp_ocp_pcidev_id);
319773bda96SJonathan Lemon 
320773bda96SJonathan Lemon static DEFINE_MUTEX(ptp_ocp_lock);
321773bda96SJonathan Lemon static DEFINE_IDR(ptp_ocp_idr);
322773bda96SJonathan Lemon 
323773bda96SJonathan Lemon static struct {
324773bda96SJonathan Lemon 	const char *name;
325773bda96SJonathan Lemon 	int value;
326773bda96SJonathan Lemon } ptp_ocp_clock[] = {
327773bda96SJonathan Lemon 	{ .name = "NONE",	.value = 0 },
328773bda96SJonathan Lemon 	{ .name = "TOD",	.value = 1 },
329773bda96SJonathan Lemon 	{ .name = "IRIG",	.value = 2 },
330773bda96SJonathan Lemon 	{ .name = "PPS",	.value = 3 },
331773bda96SJonathan Lemon 	{ .name = "PTP",	.value = 4 },
332773bda96SJonathan Lemon 	{ .name = "RTC",	.value = 5 },
333773bda96SJonathan Lemon 	{ .name = "DCF",	.value = 6 },
334773bda96SJonathan Lemon 	{ .name = "REGS",	.value = 0xfe },
335773bda96SJonathan Lemon 	{ .name = "EXT",	.value = 0xff },
336773bda96SJonathan Lemon };
337773bda96SJonathan Lemon 
338773bda96SJonathan Lemon static const char *
339773bda96SJonathan Lemon ptp_ocp_clock_name_from_val(int val)
340773bda96SJonathan Lemon {
341773bda96SJonathan Lemon 	int i;
342773bda96SJonathan Lemon 
343773bda96SJonathan Lemon 	for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++)
344773bda96SJonathan Lemon 		if (ptp_ocp_clock[i].value == val)
345773bda96SJonathan Lemon 			return ptp_ocp_clock[i].name;
346773bda96SJonathan Lemon 	return NULL;
347773bda96SJonathan Lemon }
348773bda96SJonathan Lemon 
349773bda96SJonathan Lemon static int
350773bda96SJonathan Lemon ptp_ocp_clock_val_from_name(const char *name)
351773bda96SJonathan Lemon {
352773bda96SJonathan Lemon 	const char *clk;
353773bda96SJonathan Lemon 	int i;
354773bda96SJonathan Lemon 
355773bda96SJonathan Lemon 	for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++) {
356773bda96SJonathan Lemon 		clk = ptp_ocp_clock[i].name;
357773bda96SJonathan Lemon 		if (!strncasecmp(name, clk, strlen(clk)))
358773bda96SJonathan Lemon 			return ptp_ocp_clock[i].value;
359773bda96SJonathan Lemon 	}
360773bda96SJonathan Lemon 	return -EINVAL;
361773bda96SJonathan Lemon }
362773bda96SJonathan Lemon 
363a7e1abadSJonathan Lemon static int
364a7e1abadSJonathan Lemon __ptp_ocp_gettime_locked(struct ptp_ocp *bp, struct timespec64 *ts,
365a7e1abadSJonathan Lemon 			 struct ptp_system_timestamp *sts)
366a7e1abadSJonathan Lemon {
367a7e1abadSJonathan Lemon 	u32 ctrl, time_sec, time_ns;
368a7e1abadSJonathan Lemon 	int i;
369a7e1abadSJonathan Lemon 
370a7e1abadSJonathan Lemon 	ctrl = ioread32(&bp->reg->ctrl);
371a7e1abadSJonathan Lemon 	ctrl |= OCP_CTRL_READ_TIME_REQ;
372a7e1abadSJonathan Lemon 
373a7e1abadSJonathan Lemon 	ptp_read_system_prets(sts);
374a7e1abadSJonathan Lemon 	iowrite32(ctrl, &bp->reg->ctrl);
375a7e1abadSJonathan Lemon 
376a7e1abadSJonathan Lemon 	for (i = 0; i < 100; i++) {
377a7e1abadSJonathan Lemon 		ctrl = ioread32(&bp->reg->ctrl);
378a7e1abadSJonathan Lemon 		if (ctrl & OCP_CTRL_READ_TIME_DONE)
379a7e1abadSJonathan Lemon 			break;
380a7e1abadSJonathan Lemon 	}
381a7e1abadSJonathan Lemon 	ptp_read_system_postts(sts);
382a7e1abadSJonathan Lemon 
383a7e1abadSJonathan Lemon 	time_ns = ioread32(&bp->reg->time_ns);
384a7e1abadSJonathan Lemon 	time_sec = ioread32(&bp->reg->time_sec);
385a7e1abadSJonathan Lemon 
386a7e1abadSJonathan Lemon 	ts->tv_sec = time_sec;
387a7e1abadSJonathan Lemon 	ts->tv_nsec = time_ns;
388a7e1abadSJonathan Lemon 
389a7e1abadSJonathan Lemon 	return ctrl & OCP_CTRL_READ_TIME_DONE ? 0 : -ETIMEDOUT;
390a7e1abadSJonathan Lemon }
391a7e1abadSJonathan Lemon 
392a7e1abadSJonathan Lemon static int
393a7e1abadSJonathan Lemon ptp_ocp_gettimex(struct ptp_clock_info *ptp_info, struct timespec64 *ts,
394a7e1abadSJonathan Lemon 		 struct ptp_system_timestamp *sts)
395a7e1abadSJonathan Lemon {
396a7e1abadSJonathan Lemon 	struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info);
397a7e1abadSJonathan Lemon 	unsigned long flags;
398a7e1abadSJonathan Lemon 	int err;
399a7e1abadSJonathan Lemon 
400a7e1abadSJonathan Lemon 	spin_lock_irqsave(&bp->lock, flags);
401a7e1abadSJonathan Lemon 	err = __ptp_ocp_gettime_locked(bp, ts, sts);
402a7e1abadSJonathan Lemon 	spin_unlock_irqrestore(&bp->lock, flags);
403a7e1abadSJonathan Lemon 
404a7e1abadSJonathan Lemon 	return err;
405a7e1abadSJonathan Lemon }
406a7e1abadSJonathan Lemon 
407a7e1abadSJonathan Lemon static void
408a7e1abadSJonathan Lemon __ptp_ocp_settime_locked(struct ptp_ocp *bp, const struct timespec64 *ts)
409a7e1abadSJonathan Lemon {
410a7e1abadSJonathan Lemon 	u32 ctrl, time_sec, time_ns;
411a7e1abadSJonathan Lemon 	u32 select;
412a7e1abadSJonathan Lemon 
413a7e1abadSJonathan Lemon 	time_ns = ts->tv_nsec;
414a7e1abadSJonathan Lemon 	time_sec = ts->tv_sec;
415a7e1abadSJonathan Lemon 
416a7e1abadSJonathan Lemon 	select = ioread32(&bp->reg->select);
417a7e1abadSJonathan Lemon 	iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select);
418a7e1abadSJonathan Lemon 
419a7e1abadSJonathan Lemon 	iowrite32(time_ns, &bp->reg->adjust_ns);
420a7e1abadSJonathan Lemon 	iowrite32(time_sec, &bp->reg->adjust_sec);
421a7e1abadSJonathan Lemon 
422a7e1abadSJonathan Lemon 	ctrl = ioread32(&bp->reg->ctrl);
423a7e1abadSJonathan Lemon 	ctrl |= OCP_CTRL_ADJUST_TIME;
424a7e1abadSJonathan Lemon 	iowrite32(ctrl, &bp->reg->ctrl);
425a7e1abadSJonathan Lemon 
426a7e1abadSJonathan Lemon 	/* restore clock selection */
427a7e1abadSJonathan Lemon 	iowrite32(select >> 16, &bp->reg->select);
428a7e1abadSJonathan Lemon }
429a7e1abadSJonathan Lemon 
430a7e1abadSJonathan Lemon static int
431a7e1abadSJonathan Lemon ptp_ocp_settime(struct ptp_clock_info *ptp_info, const struct timespec64 *ts)
432a7e1abadSJonathan Lemon {
433a7e1abadSJonathan Lemon 	struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info);
434a7e1abadSJonathan Lemon 	unsigned long flags;
435a7e1abadSJonathan Lemon 
436a7e1abadSJonathan Lemon 	if (ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC)
437a7e1abadSJonathan Lemon 		return 0;
438a7e1abadSJonathan Lemon 
439a7e1abadSJonathan Lemon 	spin_lock_irqsave(&bp->lock, flags);
440a7e1abadSJonathan Lemon 	__ptp_ocp_settime_locked(bp, ts);
441a7e1abadSJonathan Lemon 	spin_unlock_irqrestore(&bp->lock, flags);
442a7e1abadSJonathan Lemon 
443a7e1abadSJonathan Lemon 	return 0;
444a7e1abadSJonathan Lemon }
445a7e1abadSJonathan Lemon 
446a7e1abadSJonathan Lemon static int
447a7e1abadSJonathan Lemon ptp_ocp_adjtime(struct ptp_clock_info *ptp_info, s64 delta_ns)
448a7e1abadSJonathan Lemon {
449a7e1abadSJonathan Lemon 	struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info);
450a7e1abadSJonathan Lemon 	struct timespec64 ts;
451a7e1abadSJonathan Lemon 	unsigned long flags;
452a7e1abadSJonathan Lemon 	int err;
453a7e1abadSJonathan Lemon 
454a7e1abadSJonathan Lemon 	if (ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC)
455a7e1abadSJonathan Lemon 		return 0;
456a7e1abadSJonathan Lemon 
457a7e1abadSJonathan Lemon 	spin_lock_irqsave(&bp->lock, flags);
458a7e1abadSJonathan Lemon 	err = __ptp_ocp_gettime_locked(bp, &ts, NULL);
459a7e1abadSJonathan Lemon 	if (likely(!err)) {
460a7e1abadSJonathan Lemon 		timespec64_add_ns(&ts, delta_ns);
461a7e1abadSJonathan Lemon 		__ptp_ocp_settime_locked(bp, &ts);
462a7e1abadSJonathan Lemon 	}
463a7e1abadSJonathan Lemon 	spin_unlock_irqrestore(&bp->lock, flags);
464a7e1abadSJonathan Lemon 
465a7e1abadSJonathan Lemon 	return err;
466a7e1abadSJonathan Lemon }
467a7e1abadSJonathan Lemon 
468a7e1abadSJonathan Lemon static int
469a7e1abadSJonathan Lemon ptp_ocp_null_adjfine(struct ptp_clock_info *ptp_info, long scaled_ppm)
470a7e1abadSJonathan Lemon {
471a7e1abadSJonathan Lemon 	if (scaled_ppm == 0)
472a7e1abadSJonathan Lemon 		return 0;
473a7e1abadSJonathan Lemon 
474a7e1abadSJonathan Lemon 	return -EOPNOTSUPP;
475a7e1abadSJonathan Lemon }
476a7e1abadSJonathan Lemon 
477773bda96SJonathan Lemon static int
478773bda96SJonathan Lemon ptp_ocp_adjphase(struct ptp_clock_info *ptp_info, s32 phase_ns)
479773bda96SJonathan Lemon {
480773bda96SJonathan Lemon 	return -EOPNOTSUPP;
481773bda96SJonathan Lemon }
482773bda96SJonathan Lemon 
483773bda96SJonathan Lemon static int
484773bda96SJonathan Lemon ptp_ocp_enable(struct ptp_clock_info *ptp_info, struct ptp_clock_request *rq,
485773bda96SJonathan Lemon 	       int on)
486773bda96SJonathan Lemon {
487773bda96SJonathan Lemon 	struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info);
488773bda96SJonathan Lemon 	struct ptp_ocp_ext_src *ext = NULL;
489773bda96SJonathan Lemon 	int err;
490773bda96SJonathan Lemon 
491773bda96SJonathan Lemon 	switch (rq->type) {
492773bda96SJonathan Lemon 	case PTP_CLK_REQ_EXTTS:
493773bda96SJonathan Lemon 		switch (rq->extts.index) {
494773bda96SJonathan Lemon 		case 0:
495773bda96SJonathan Lemon 			ext = bp->ts0;
496773bda96SJonathan Lemon 			break;
497773bda96SJonathan Lemon 		case 1:
498773bda96SJonathan Lemon 			ext = bp->ts1;
499773bda96SJonathan Lemon 			break;
500773bda96SJonathan Lemon 		}
501773bda96SJonathan Lemon 		break;
502773bda96SJonathan Lemon 	case PTP_CLK_REQ_PPS:
503773bda96SJonathan Lemon 		ext = bp->pps;
504773bda96SJonathan Lemon 		break;
505773bda96SJonathan Lemon 	default:
506773bda96SJonathan Lemon 		return -EOPNOTSUPP;
507773bda96SJonathan Lemon 	}
508773bda96SJonathan Lemon 
509773bda96SJonathan Lemon 	err = -ENXIO;
510773bda96SJonathan Lemon 	if (ext)
511773bda96SJonathan Lemon 		err = ext->info->enable(ext, on);
512773bda96SJonathan Lemon 
513773bda96SJonathan Lemon 	return err;
514773bda96SJonathan Lemon }
515773bda96SJonathan Lemon 
516a7e1abadSJonathan Lemon static const struct ptp_clock_info ptp_ocp_clock_info = {
517a7e1abadSJonathan Lemon 	.owner		= THIS_MODULE,
518a7e1abadSJonathan Lemon 	.name		= KBUILD_MODNAME,
519a7e1abadSJonathan Lemon 	.max_adj	= 100000000,
520a7e1abadSJonathan Lemon 	.gettimex64	= ptp_ocp_gettimex,
521a7e1abadSJonathan Lemon 	.settime64	= ptp_ocp_settime,
522a7e1abadSJonathan Lemon 	.adjtime	= ptp_ocp_adjtime,
523a7e1abadSJonathan Lemon 	.adjfine	= ptp_ocp_null_adjfine,
524773bda96SJonathan Lemon 	.adjphase	= ptp_ocp_adjphase,
525773bda96SJonathan Lemon 	.enable		= ptp_ocp_enable,
526773bda96SJonathan Lemon 	.pps		= true,
527773bda96SJonathan Lemon 	.n_ext_ts	= 2,
528a7e1abadSJonathan Lemon };
529a7e1abadSJonathan Lemon 
530773bda96SJonathan Lemon static void
531773bda96SJonathan Lemon __ptp_ocp_clear_drift_locked(struct ptp_ocp *bp)
532773bda96SJonathan Lemon {
533773bda96SJonathan Lemon 	u32 ctrl, select;
534773bda96SJonathan Lemon 
535773bda96SJonathan Lemon 	select = ioread32(&bp->reg->select);
536773bda96SJonathan Lemon 	iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select);
537773bda96SJonathan Lemon 
538773bda96SJonathan Lemon 	iowrite32(0, &bp->reg->drift_ns);
539773bda96SJonathan Lemon 
540773bda96SJonathan Lemon 	ctrl = ioread32(&bp->reg->ctrl);
541773bda96SJonathan Lemon 	ctrl |= OCP_CTRL_ADJUST_DRIFT;
542773bda96SJonathan Lemon 	iowrite32(ctrl, &bp->reg->ctrl);
543773bda96SJonathan Lemon 
544773bda96SJonathan Lemon 	/* restore clock selection */
545773bda96SJonathan Lemon 	iowrite32(select >> 16, &bp->reg->select);
546773bda96SJonathan Lemon }
547773bda96SJonathan Lemon 
548773bda96SJonathan Lemon static void
549773bda96SJonathan Lemon ptp_ocp_watchdog(struct timer_list *t)
550773bda96SJonathan Lemon {
551773bda96SJonathan Lemon 	struct ptp_ocp *bp = from_timer(bp, t, watchdog);
552773bda96SJonathan Lemon 	unsigned long flags;
553773bda96SJonathan Lemon 	u32 status;
554773bda96SJonathan Lemon 
5550d43d4f2SJonathan Lemon 	status = ioread32(&bp->pps_to_clk->status);
556773bda96SJonathan Lemon 
557773bda96SJonathan Lemon 	if (status & PPS_STATUS_SUPERV_ERR) {
5580d43d4f2SJonathan Lemon 		iowrite32(status, &bp->pps_to_clk->status);
559ef0cfb34SJonathan Lemon 		if (!bp->gnss_lost) {
560773bda96SJonathan Lemon 			spin_lock_irqsave(&bp->lock, flags);
561773bda96SJonathan Lemon 			__ptp_ocp_clear_drift_locked(bp);
562773bda96SJonathan Lemon 			spin_unlock_irqrestore(&bp->lock, flags);
563ef0cfb34SJonathan Lemon 			bp->gnss_lost = ktime_get_real_seconds();
564773bda96SJonathan Lemon 		}
565773bda96SJonathan Lemon 
566ef0cfb34SJonathan Lemon 	} else if (bp->gnss_lost) {
567ef0cfb34SJonathan Lemon 		bp->gnss_lost = 0;
568773bda96SJonathan Lemon 	}
569773bda96SJonathan Lemon 
570773bda96SJonathan Lemon 	mod_timer(&bp->watchdog, jiffies + HZ);
571773bda96SJonathan Lemon }
572773bda96SJonathan Lemon 
573a7e1abadSJonathan Lemon static int
574773bda96SJonathan Lemon ptp_ocp_init_clock(struct ptp_ocp *bp)
575a7e1abadSJonathan Lemon {
576a7e1abadSJonathan Lemon 	struct timespec64 ts;
577a7e1abadSJonathan Lemon 	bool sync;
578a7e1abadSJonathan Lemon 	u32 ctrl;
579a7e1abadSJonathan Lemon 
580a7e1abadSJonathan Lemon 	/* make sure clock is enabled */
581a7e1abadSJonathan Lemon 	ctrl = ioread32(&bp->reg->ctrl);
582a7e1abadSJonathan Lemon 	ctrl |= OCP_CTRL_ENABLE;
583a7e1abadSJonathan Lemon 	iowrite32(ctrl, &bp->reg->ctrl);
584a7e1abadSJonathan Lemon 
585773bda96SJonathan Lemon 	/* NO DRIFT Correction */
586773bda96SJonathan Lemon 	/* offset_p:i 1/8, offset_i: 1/16, drift_p: 0, drift_i: 0 */
587773bda96SJonathan Lemon 	iowrite32(0x2000, &bp->reg->servo_offset_p);
588773bda96SJonathan Lemon 	iowrite32(0x1000, &bp->reg->servo_offset_i);
589773bda96SJonathan Lemon 	iowrite32(0,	  &bp->reg->servo_drift_p);
590773bda96SJonathan Lemon 	iowrite32(0,	  &bp->reg->servo_drift_i);
591773bda96SJonathan Lemon 
592773bda96SJonathan Lemon 	/* latch servo values */
593773bda96SJonathan Lemon 	ctrl |= OCP_CTRL_ADJUST_SERVO;
594773bda96SJonathan Lemon 	iowrite32(ctrl, &bp->reg->ctrl);
595773bda96SJonathan Lemon 
596a7e1abadSJonathan Lemon 	if ((ioread32(&bp->reg->ctrl) & OCP_CTRL_ENABLE) == 0) {
597a7e1abadSJonathan Lemon 		dev_err(&bp->pdev->dev, "clock not enabled\n");
598a7e1abadSJonathan Lemon 		return -ENODEV;
599a7e1abadSJonathan Lemon 	}
600a7e1abadSJonathan Lemon 
601a7e1abadSJonathan Lemon 	sync = ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC;
602a7e1abadSJonathan Lemon 	if (!sync) {
603a7e1abadSJonathan Lemon 		ktime_get_real_ts64(&ts);
604a7e1abadSJonathan Lemon 		ptp_ocp_settime(&bp->ptp_info, &ts);
605a7e1abadSJonathan Lemon 	}
606a7e1abadSJonathan Lemon 	if (!ptp_ocp_gettimex(&bp->ptp_info, &ts, NULL))
607a7e1abadSJonathan Lemon 		dev_info(&bp->pdev->dev, "Time: %lld.%ld, %s\n",
608a7e1abadSJonathan Lemon 			 ts.tv_sec, ts.tv_nsec,
609a7e1abadSJonathan Lemon 			 sync ? "in-sync" : "UNSYNCED");
610a7e1abadSJonathan Lemon 
611773bda96SJonathan Lemon 	timer_setup(&bp->watchdog, ptp_ocp_watchdog, 0);
612773bda96SJonathan Lemon 	mod_timer(&bp->watchdog, jiffies + HZ);
613773bda96SJonathan Lemon 
614a7e1abadSJonathan Lemon 	return 0;
615a7e1abadSJonathan Lemon }
616a7e1abadSJonathan Lemon 
617a7e1abadSJonathan Lemon static void
618a7e1abadSJonathan Lemon ptp_ocp_tod_info(struct ptp_ocp *bp)
619a7e1abadSJonathan Lemon {
620a7e1abadSJonathan Lemon 	static const char * const proto_name[] = {
621a7e1abadSJonathan Lemon 		"NMEA", "NMEA_ZDA", "NMEA_RMC", "NMEA_none",
622a7e1abadSJonathan Lemon 		"UBX", "UBX_UTC", "UBX_LS", "UBX_none"
623a7e1abadSJonathan Lemon 	};
624a7e1abadSJonathan Lemon 	static const char * const gnss_name[] = {
625a7e1abadSJonathan Lemon 		"ALL", "COMBINED", "GPS", "GLONASS", "GALILEO", "BEIDOU",
626a7e1abadSJonathan Lemon 	};
627a7e1abadSJonathan Lemon 	u32 version, ctrl, reg;
628a7e1abadSJonathan Lemon 	int idx;
629a7e1abadSJonathan Lemon 
630a7e1abadSJonathan Lemon 	version = ioread32(&bp->tod->version);
631a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "TOD Version %d.%d.%d\n",
632a7e1abadSJonathan Lemon 		 version >> 24, (version >> 16) & 0xff, version & 0xffff);
633a7e1abadSJonathan Lemon 
634a7e1abadSJonathan Lemon 	ctrl = ioread32(&bp->tod->ctrl);
635a7e1abadSJonathan Lemon 	ctrl |= TOD_CTRL_PROTOCOL | TOD_CTRL_ENABLE;
636a7e1abadSJonathan Lemon 	ctrl &= ~(TOD_CTRL_DISABLE_FMT_A | TOD_CTRL_DISABLE_FMT_B);
637a7e1abadSJonathan Lemon 	iowrite32(ctrl, &bp->tod->ctrl);
638a7e1abadSJonathan Lemon 
639a7e1abadSJonathan Lemon 	ctrl = ioread32(&bp->tod->ctrl);
640a7e1abadSJonathan Lemon 	idx = ctrl & TOD_CTRL_PROTOCOL ? 4 : 0;
641a7e1abadSJonathan Lemon 	idx += (ctrl >> 16) & 3;
642a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "control: %x\n", ctrl);
643a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "TOD Protocol %s %s\n", proto_name[idx],
644a7e1abadSJonathan Lemon 		 ctrl & TOD_CTRL_ENABLE ? "enabled" : "");
645a7e1abadSJonathan Lemon 
646a7e1abadSJonathan Lemon 	idx = (ctrl >> TOD_CTRL_GNSS_SHIFT) & TOD_CTRL_GNSS_MASK;
647a7e1abadSJonathan Lemon 	if (idx < ARRAY_SIZE(gnss_name))
648a7e1abadSJonathan Lemon 		dev_info(&bp->pdev->dev, "GNSS %s\n", gnss_name[idx]);
649a7e1abadSJonathan Lemon 
650a7e1abadSJonathan Lemon 	reg = ioread32(&bp->tod->status);
651a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "status: %x\n", reg);
652a7e1abadSJonathan Lemon 
653a7e1abadSJonathan Lemon 	reg = ioread32(&bp->tod->correction_sec);
654a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "correction: %d\n", reg);
655a7e1abadSJonathan Lemon 
656a7e1abadSJonathan Lemon 	reg = ioread32(&bp->tod->utc_status);
657a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "utc_status: %x\n", reg);
658a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "utc_offset: %d  valid:%d  leap_valid:%d\n",
659a7e1abadSJonathan Lemon 		 reg & TOD_STATUS_UTC_MASK, reg & TOD_STATUS_UTC_VALID ? 1 : 0,
660a7e1abadSJonathan Lemon 		 reg & TOD_STATUS_LEAP_VALID ? 1 : 0);
661a7e1abadSJonathan Lemon }
662a7e1abadSJonathan Lemon 
663773bda96SJonathan Lemon static int
664773bda96SJonathan Lemon ptp_ocp_firstchild(struct device *dev, void *data)
665773bda96SJonathan Lemon {
666773bda96SJonathan Lemon 	return 1;
667773bda96SJonathan Lemon }
668773bda96SJonathan Lemon 
669773bda96SJonathan Lemon static int
670773bda96SJonathan Lemon ptp_ocp_read_i2c(struct i2c_adapter *adap, u8 addr, u8 reg, u8 sz, u8 *data)
671773bda96SJonathan Lemon {
672773bda96SJonathan Lemon 	struct i2c_msg msgs[2] = {
673773bda96SJonathan Lemon 		{
674773bda96SJonathan Lemon 			.addr = addr,
675773bda96SJonathan Lemon 			.len = 1,
676773bda96SJonathan Lemon 			.buf = &reg,
677773bda96SJonathan Lemon 		},
678773bda96SJonathan Lemon 		{
679773bda96SJonathan Lemon 			.addr = addr,
680773bda96SJonathan Lemon 			.flags = I2C_M_RD,
681773bda96SJonathan Lemon 			.len = 2,
682773bda96SJonathan Lemon 			.buf = data,
683773bda96SJonathan Lemon 		},
684773bda96SJonathan Lemon 	};
685773bda96SJonathan Lemon 	int err;
686773bda96SJonathan Lemon 	u8 len;
687773bda96SJonathan Lemon 
688773bda96SJonathan Lemon 	/* xiic-i2c for some stupid reason only does 2 byte reads. */
689773bda96SJonathan Lemon 	while (sz) {
690773bda96SJonathan Lemon 		len = min_t(u8, sz, 2);
691773bda96SJonathan Lemon 		msgs[1].len = len;
692773bda96SJonathan Lemon 		err = i2c_transfer(adap, msgs, 2);
693773bda96SJonathan Lemon 		if (err != msgs[1].len)
694773bda96SJonathan Lemon 			return err;
695773bda96SJonathan Lemon 		msgs[1].buf += len;
696773bda96SJonathan Lemon 		reg += len;
697773bda96SJonathan Lemon 		sz -= len;
698773bda96SJonathan Lemon 	}
699773bda96SJonathan Lemon 	return 0;
700773bda96SJonathan Lemon }
701773bda96SJonathan Lemon 
702773bda96SJonathan Lemon static void
703773bda96SJonathan Lemon ptp_ocp_get_serial_number(struct ptp_ocp *bp)
704773bda96SJonathan Lemon {
705773bda96SJonathan Lemon 	struct i2c_adapter *adap;
706773bda96SJonathan Lemon 	struct device *dev;
707773bda96SJonathan Lemon 	int err;
708773bda96SJonathan Lemon 
7091447149dSJonathan Lemon 	if (!bp->i2c_ctrl)
7101447149dSJonathan Lemon 		return;
7111447149dSJonathan Lemon 
712773bda96SJonathan Lemon 	dev = device_find_child(&bp->i2c_ctrl->dev, NULL, ptp_ocp_firstchild);
713773bda96SJonathan Lemon 	if (!dev) {
714773bda96SJonathan Lemon 		dev_err(&bp->pdev->dev, "Can't find I2C adapter\n");
715773bda96SJonathan Lemon 		return;
716773bda96SJonathan Lemon 	}
717773bda96SJonathan Lemon 
718773bda96SJonathan Lemon 	adap = i2c_verify_adapter(dev);
719773bda96SJonathan Lemon 	if (!adap) {
720773bda96SJonathan Lemon 		dev_err(&bp->pdev->dev, "device '%s' isn't an I2C adapter\n",
721773bda96SJonathan Lemon 			dev_name(dev));
722773bda96SJonathan Lemon 		goto out;
723773bda96SJonathan Lemon 	}
724773bda96SJonathan Lemon 
725773bda96SJonathan Lemon 	err = ptp_ocp_read_i2c(adap, 0x58, 0x9A, 6, bp->serial);
726773bda96SJonathan Lemon 	if (err) {
727773bda96SJonathan Lemon 		dev_err(&bp->pdev->dev, "could not read eeprom: %d\n", err);
728773bda96SJonathan Lemon 		goto out;
729773bda96SJonathan Lemon 	}
730773bda96SJonathan Lemon 
731773bda96SJonathan Lemon 	bp->has_serial = true;
732773bda96SJonathan Lemon 
733773bda96SJonathan Lemon out:
734773bda96SJonathan Lemon 	put_device(dev);
735773bda96SJonathan Lemon }
736773bda96SJonathan Lemon 
737a7e1abadSJonathan Lemon static void
738a7e1abadSJonathan Lemon ptp_ocp_info(struct ptp_ocp *bp)
739a7e1abadSJonathan Lemon {
740a7e1abadSJonathan Lemon 	u32 version, select;
741a7e1abadSJonathan Lemon 
742a7e1abadSJonathan Lemon 	version = ioread32(&bp->reg->version);
743a7e1abadSJonathan Lemon 	select = ioread32(&bp->reg->select);
744a7e1abadSJonathan Lemon 	dev_info(&bp->pdev->dev, "Version %d.%d.%d, clock %s, device ptp%d\n",
745a7e1abadSJonathan Lemon 		 version >> 24, (version >> 16) & 0xff, version & 0xffff,
746773bda96SJonathan Lemon 		 ptp_ocp_clock_name_from_val(select >> 16),
747a7e1abadSJonathan Lemon 		 ptp_clock_index(bp->ptp));
748a7e1abadSJonathan Lemon 
749498ad3f4SJonathan Lemon 	if (bp->tod)
750a7e1abadSJonathan Lemon 		ptp_ocp_tod_info(bp);
751a7e1abadSJonathan Lemon }
752a7e1abadSJonathan Lemon 
753773bda96SJonathan Lemon static struct device *
754773bda96SJonathan Lemon ptp_ocp_find_flash(struct ptp_ocp *bp)
755773bda96SJonathan Lemon {
756773bda96SJonathan Lemon 	struct device *dev, *last;
757773bda96SJonathan Lemon 
758773bda96SJonathan Lemon 	last = NULL;
759773bda96SJonathan Lemon 	dev = &bp->spi_flash->dev;
760773bda96SJonathan Lemon 
761773bda96SJonathan Lemon 	while ((dev = device_find_child(dev, NULL, ptp_ocp_firstchild))) {
762773bda96SJonathan Lemon 		if (!strcmp("mtd", dev_bus_name(dev)))
763773bda96SJonathan Lemon 			break;
764773bda96SJonathan Lemon 		put_device(last);
765773bda96SJonathan Lemon 		last = dev;
766773bda96SJonathan Lemon 	}
767773bda96SJonathan Lemon 	put_device(last);
768773bda96SJonathan Lemon 
769773bda96SJonathan Lemon 	return dev;
770773bda96SJonathan Lemon }
771773bda96SJonathan Lemon 
772773bda96SJonathan Lemon static int
773773bda96SJonathan Lemon ptp_ocp_devlink_flash(struct devlink *devlink, struct device *dev,
774773bda96SJonathan Lemon 		      const struct firmware *fw)
775773bda96SJonathan Lemon {
776773bda96SJonathan Lemon 	struct mtd_info *mtd = dev_get_drvdata(dev);
777773bda96SJonathan Lemon 	struct ptp_ocp *bp = devlink_priv(devlink);
778773bda96SJonathan Lemon 	size_t off, len, resid, wrote;
779773bda96SJonathan Lemon 	struct erase_info erase;
780773bda96SJonathan Lemon 	size_t base, blksz;
7817c807572SJonathan Lemon 	int err = 0;
782773bda96SJonathan Lemon 
783773bda96SJonathan Lemon 	off = 0;
784773bda96SJonathan Lemon 	base = bp->flash_start;
785773bda96SJonathan Lemon 	blksz = 4096;
786773bda96SJonathan Lemon 	resid = fw->size;
787773bda96SJonathan Lemon 
788773bda96SJonathan Lemon 	while (resid) {
789773bda96SJonathan Lemon 		devlink_flash_update_status_notify(devlink, "Flashing",
790773bda96SJonathan Lemon 						   NULL, off, fw->size);
791773bda96SJonathan Lemon 
792773bda96SJonathan Lemon 		len = min_t(size_t, resid, blksz);
793773bda96SJonathan Lemon 		erase.addr = base + off;
794773bda96SJonathan Lemon 		erase.len = blksz;
795773bda96SJonathan Lemon 
796773bda96SJonathan Lemon 		err = mtd_erase(mtd, &erase);
797773bda96SJonathan Lemon 		if (err)
798773bda96SJonathan Lemon 			goto out;
799773bda96SJonathan Lemon 
800773bda96SJonathan Lemon 		err = mtd_write(mtd, base + off, len, &wrote, &fw->data[off]);
801773bda96SJonathan Lemon 		if (err)
802773bda96SJonathan Lemon 			goto out;
803773bda96SJonathan Lemon 
804773bda96SJonathan Lemon 		off += blksz;
805773bda96SJonathan Lemon 		resid -= len;
806773bda96SJonathan Lemon 	}
807773bda96SJonathan Lemon out:
808773bda96SJonathan Lemon 	return err;
809773bda96SJonathan Lemon }
810773bda96SJonathan Lemon 
811773bda96SJonathan Lemon static int
812773bda96SJonathan Lemon ptp_ocp_devlink_flash_update(struct devlink *devlink,
813773bda96SJonathan Lemon 			     struct devlink_flash_update_params *params,
814773bda96SJonathan Lemon 			     struct netlink_ext_ack *extack)
815773bda96SJonathan Lemon {
816773bda96SJonathan Lemon 	struct ptp_ocp *bp = devlink_priv(devlink);
817773bda96SJonathan Lemon 	struct device *dev;
818773bda96SJonathan Lemon 	const char *msg;
819773bda96SJonathan Lemon 	int err;
820773bda96SJonathan Lemon 
821773bda96SJonathan Lemon 	dev = ptp_ocp_find_flash(bp);
822773bda96SJonathan Lemon 	if (!dev) {
823773bda96SJonathan Lemon 		dev_err(&bp->pdev->dev, "Can't find Flash SPI adapter\n");
824773bda96SJonathan Lemon 		return -ENODEV;
825773bda96SJonathan Lemon 	}
826773bda96SJonathan Lemon 
827773bda96SJonathan Lemon 	devlink_flash_update_status_notify(devlink, "Preparing to flash",
828773bda96SJonathan Lemon 					   NULL, 0, 0);
829773bda96SJonathan Lemon 
830773bda96SJonathan Lemon 	err = ptp_ocp_devlink_flash(devlink, dev, params->fw);
831773bda96SJonathan Lemon 
832773bda96SJonathan Lemon 	msg = err ? "Flash error" : "Flash complete";
833773bda96SJonathan Lemon 	devlink_flash_update_status_notify(devlink, msg, NULL, 0, 0);
834773bda96SJonathan Lemon 
835773bda96SJonathan Lemon 	put_device(dev);
836773bda96SJonathan Lemon 	return err;
837773bda96SJonathan Lemon }
838773bda96SJonathan Lemon 
839773bda96SJonathan Lemon static int
840773bda96SJonathan Lemon ptp_ocp_devlink_info_get(struct devlink *devlink, struct devlink_info_req *req,
841773bda96SJonathan Lemon 			 struct netlink_ext_ack *extack)
842773bda96SJonathan Lemon {
843773bda96SJonathan Lemon 	struct ptp_ocp *bp = devlink_priv(devlink);
844773bda96SJonathan Lemon 	char buf[32];
845773bda96SJonathan Lemon 	int err;
846773bda96SJonathan Lemon 
847773bda96SJonathan Lemon 	err = devlink_info_driver_name_put(req, KBUILD_MODNAME);
848773bda96SJonathan Lemon 	if (err)
849773bda96SJonathan Lemon 		return err;
850773bda96SJonathan Lemon 
851773bda96SJonathan Lemon 	if (bp->image) {
852773bda96SJonathan Lemon 		u32 ver = ioread32(&bp->image->version);
853773bda96SJonathan Lemon 
854773bda96SJonathan Lemon 		if (ver & 0xffff) {
855773bda96SJonathan Lemon 			sprintf(buf, "%d", ver);
856773bda96SJonathan Lemon 			err = devlink_info_version_running_put(req,
8571a052da9SJonathan Lemon 							       "fw",
858773bda96SJonathan Lemon 							       buf);
859773bda96SJonathan Lemon 		} else {
860773bda96SJonathan Lemon 			sprintf(buf, "%d", ver >> 16);
861773bda96SJonathan Lemon 			err = devlink_info_version_running_put(req,
8621a052da9SJonathan Lemon 							       "loader",
863773bda96SJonathan Lemon 							       buf);
864773bda96SJonathan Lemon 		}
865773bda96SJonathan Lemon 		if (err)
866773bda96SJonathan Lemon 			return err;
867773bda96SJonathan Lemon 	}
868773bda96SJonathan Lemon 
869773bda96SJonathan Lemon 	if (!bp->has_serial)
870773bda96SJonathan Lemon 		ptp_ocp_get_serial_number(bp);
871773bda96SJonathan Lemon 
872773bda96SJonathan Lemon 	if (bp->has_serial) {
873773bda96SJonathan Lemon 		sprintf(buf, "%pM", bp->serial);
874773bda96SJonathan Lemon 		err = devlink_info_serial_number_put(req, buf);
875773bda96SJonathan Lemon 		if (err)
876773bda96SJonathan Lemon 			return err;
877773bda96SJonathan Lemon 	}
878773bda96SJonathan Lemon 
879773bda96SJonathan Lemon 	return 0;
880773bda96SJonathan Lemon }
881773bda96SJonathan Lemon 
882773bda96SJonathan Lemon static const struct devlink_ops ptp_ocp_devlink_ops = {
883773bda96SJonathan Lemon 	.flash_update = ptp_ocp_devlink_flash_update,
884773bda96SJonathan Lemon 	.info_get = ptp_ocp_devlink_info_get,
885773bda96SJonathan Lemon };
886773bda96SJonathan Lemon 
887773bda96SJonathan Lemon static void __iomem *
888773bda96SJonathan Lemon __ptp_ocp_get_mem(struct ptp_ocp *bp, unsigned long start, int size)
889773bda96SJonathan Lemon {
890773bda96SJonathan Lemon 	struct resource res = DEFINE_RES_MEM_NAMED(start, size, "ptp_ocp");
891773bda96SJonathan Lemon 
892773bda96SJonathan Lemon 	return devm_ioremap_resource(&bp->pdev->dev, &res);
893773bda96SJonathan Lemon }
894773bda96SJonathan Lemon 
895773bda96SJonathan Lemon static void __iomem *
896773bda96SJonathan Lemon ptp_ocp_get_mem(struct ptp_ocp *bp, struct ocp_resource *r)
897773bda96SJonathan Lemon {
898773bda96SJonathan Lemon 	unsigned long start;
899773bda96SJonathan Lemon 
900773bda96SJonathan Lemon 	start = pci_resource_start(bp->pdev, 0) + r->offset;
901773bda96SJonathan Lemon 	return __ptp_ocp_get_mem(bp, start, r->size);
902773bda96SJonathan Lemon }
903773bda96SJonathan Lemon 
904773bda96SJonathan Lemon static void
905773bda96SJonathan Lemon ptp_ocp_set_irq_resource(struct resource *res, int irq)
906773bda96SJonathan Lemon {
907773bda96SJonathan Lemon 	struct resource r = DEFINE_RES_IRQ(irq);
908773bda96SJonathan Lemon 	*res = r;
909773bda96SJonathan Lemon }
910773bda96SJonathan Lemon 
911773bda96SJonathan Lemon static void
912773bda96SJonathan Lemon ptp_ocp_set_mem_resource(struct resource *res, unsigned long start, int size)
913773bda96SJonathan Lemon {
914773bda96SJonathan Lemon 	struct resource r = DEFINE_RES_MEM(start, size);
915773bda96SJonathan Lemon 	*res = r;
916773bda96SJonathan Lemon }
917773bda96SJonathan Lemon 
918773bda96SJonathan Lemon static int
919773bda96SJonathan Lemon ptp_ocp_register_spi(struct ptp_ocp *bp, struct ocp_resource *r)
920773bda96SJonathan Lemon {
921773bda96SJonathan Lemon 	struct ptp_ocp_flash_info *info;
922773bda96SJonathan Lemon 	struct pci_dev *pdev = bp->pdev;
923773bda96SJonathan Lemon 	struct platform_device *p;
924773bda96SJonathan Lemon 	struct resource res[2];
925773bda96SJonathan Lemon 	unsigned long start;
926773bda96SJonathan Lemon 	int id;
927773bda96SJonathan Lemon 
928773bda96SJonathan Lemon 	start = pci_resource_start(pdev, 0) + r->offset;
929773bda96SJonathan Lemon 	ptp_ocp_set_mem_resource(&res[0], start, r->size);
930773bda96SJonathan Lemon 	ptp_ocp_set_irq_resource(&res[1], pci_irq_vector(pdev, r->irq_vec));
931773bda96SJonathan Lemon 
932773bda96SJonathan Lemon 	info = r->extra;
933773bda96SJonathan Lemon 	id = pci_dev_id(pdev) << 1;
934773bda96SJonathan Lemon 	id += info->pci_offset;
935773bda96SJonathan Lemon 
936773bda96SJonathan Lemon 	p = platform_device_register_resndata(&pdev->dev, info->name, id,
937773bda96SJonathan Lemon 					      res, 2, info->data,
938773bda96SJonathan Lemon 					      info->data_size);
939773bda96SJonathan Lemon 	if (IS_ERR(p))
940773bda96SJonathan Lemon 		return PTR_ERR(p);
941773bda96SJonathan Lemon 
942773bda96SJonathan Lemon 	bp_assign_entry(bp, r, p);
943773bda96SJonathan Lemon 
944773bda96SJonathan Lemon 	return 0;
945773bda96SJonathan Lemon }
946773bda96SJonathan Lemon 
947773bda96SJonathan Lemon static struct platform_device *
948773bda96SJonathan Lemon ptp_ocp_i2c_bus(struct pci_dev *pdev, struct ocp_resource *r, int id)
949773bda96SJonathan Lemon {
9501618df6aSJonathan Lemon 	struct ptp_ocp_i2c_info *info;
951773bda96SJonathan Lemon 	struct resource res[2];
952773bda96SJonathan Lemon 	unsigned long start;
953773bda96SJonathan Lemon 
9541618df6aSJonathan Lemon 	info = r->extra;
955773bda96SJonathan Lemon 	start = pci_resource_start(pdev, 0) + r->offset;
956773bda96SJonathan Lemon 	ptp_ocp_set_mem_resource(&res[0], start, r->size);
957773bda96SJonathan Lemon 	ptp_ocp_set_irq_resource(&res[1], pci_irq_vector(pdev, r->irq_vec));
958773bda96SJonathan Lemon 
9591618df6aSJonathan Lemon 	return platform_device_register_resndata(&pdev->dev, info->name,
9601618df6aSJonathan Lemon 						 id, res, 2,
9611618df6aSJonathan Lemon 						 info->data, info->data_size);
962773bda96SJonathan Lemon }
963773bda96SJonathan Lemon 
964773bda96SJonathan Lemon static int
965773bda96SJonathan Lemon ptp_ocp_register_i2c(struct ptp_ocp *bp, struct ocp_resource *r)
966773bda96SJonathan Lemon {
967773bda96SJonathan Lemon 	struct pci_dev *pdev = bp->pdev;
9681618df6aSJonathan Lemon 	struct ptp_ocp_i2c_info *info;
969773bda96SJonathan Lemon 	struct platform_device *p;
970773bda96SJonathan Lemon 	struct clk_hw *clk;
971773bda96SJonathan Lemon 	char buf[32];
972773bda96SJonathan Lemon 	int id;
973773bda96SJonathan Lemon 
9741618df6aSJonathan Lemon 	info = r->extra;
975773bda96SJonathan Lemon 	id = pci_dev_id(bp->pdev);
976773bda96SJonathan Lemon 
977773bda96SJonathan Lemon 	sprintf(buf, "AXI.%d", id);
9781618df6aSJonathan Lemon 	clk = clk_hw_register_fixed_rate(&pdev->dev, buf, NULL, 0,
9791618df6aSJonathan Lemon 					 info->fixed_rate);
980773bda96SJonathan Lemon 	if (IS_ERR(clk))
981773bda96SJonathan Lemon 		return PTR_ERR(clk);
982773bda96SJonathan Lemon 	bp->i2c_clk = clk;
983773bda96SJonathan Lemon 
9841618df6aSJonathan Lemon 	sprintf(buf, "%s.%d", info->name, id);
985773bda96SJonathan Lemon 	devm_clk_hw_register_clkdev(&pdev->dev, clk, NULL, buf);
986773bda96SJonathan Lemon 	p = ptp_ocp_i2c_bus(bp->pdev, r, id);
987773bda96SJonathan Lemon 	if (IS_ERR(p))
988773bda96SJonathan Lemon 		return PTR_ERR(p);
989773bda96SJonathan Lemon 
990773bda96SJonathan Lemon 	bp_assign_entry(bp, r, p);
991773bda96SJonathan Lemon 
992773bda96SJonathan Lemon 	return 0;
993773bda96SJonathan Lemon }
994773bda96SJonathan Lemon 
995773bda96SJonathan Lemon static irqreturn_t
996773bda96SJonathan Lemon ptp_ocp_ts_irq(int irq, void *priv)
997773bda96SJonathan Lemon {
998773bda96SJonathan Lemon 	struct ptp_ocp_ext_src *ext = priv;
999773bda96SJonathan Lemon 	struct ts_reg __iomem *reg = ext->mem;
1000773bda96SJonathan Lemon 	struct ptp_clock_event ev;
1001773bda96SJonathan Lemon 	u32 sec, nsec;
1002773bda96SJonathan Lemon 
1003773bda96SJonathan Lemon 	/* XXX should fix API - this converts s/ns -> ts -> s/ns */
1004773bda96SJonathan Lemon 	sec = ioread32(&reg->time_sec);
1005773bda96SJonathan Lemon 	nsec = ioread32(&reg->time_ns);
1006773bda96SJonathan Lemon 
1007773bda96SJonathan Lemon 	ev.type = PTP_CLOCK_EXTTS;
1008773bda96SJonathan Lemon 	ev.index = ext->info->index;
1009773bda96SJonathan Lemon 	ev.timestamp = sec * 1000000000ULL + nsec;
1010773bda96SJonathan Lemon 
1011773bda96SJonathan Lemon 	ptp_clock_event(ext->bp->ptp, &ev);
1012773bda96SJonathan Lemon 
1013773bda96SJonathan Lemon 	iowrite32(1, &reg->intr);	/* write 1 to ack */
1014773bda96SJonathan Lemon 
1015773bda96SJonathan Lemon 	return IRQ_HANDLED;
1016773bda96SJonathan Lemon }
1017773bda96SJonathan Lemon 
1018773bda96SJonathan Lemon static int
1019773bda96SJonathan Lemon ptp_ocp_ts_enable(void *priv, bool enable)
1020773bda96SJonathan Lemon {
1021773bda96SJonathan Lemon 	struct ptp_ocp_ext_src *ext = priv;
1022773bda96SJonathan Lemon 	struct ts_reg __iomem *reg = ext->mem;
1023773bda96SJonathan Lemon 
1024773bda96SJonathan Lemon 	if (enable) {
1025773bda96SJonathan Lemon 		iowrite32(1, &reg->enable);
1026773bda96SJonathan Lemon 		iowrite32(1, &reg->intr_mask);
1027773bda96SJonathan Lemon 		iowrite32(1, &reg->intr);
1028773bda96SJonathan Lemon 	} else {
1029773bda96SJonathan Lemon 		iowrite32(0, &reg->intr_mask);
1030773bda96SJonathan Lemon 		iowrite32(0, &reg->enable);
1031773bda96SJonathan Lemon 	}
1032773bda96SJonathan Lemon 
1033773bda96SJonathan Lemon 	return 0;
1034773bda96SJonathan Lemon }
1035773bda96SJonathan Lemon 
1036773bda96SJonathan Lemon static void
1037773bda96SJonathan Lemon ptp_ocp_unregister_ext(struct ptp_ocp_ext_src *ext)
1038773bda96SJonathan Lemon {
1039773bda96SJonathan Lemon 	ext->info->enable(ext, false);
1040773bda96SJonathan Lemon 	pci_free_irq(ext->bp->pdev, ext->irq_vec, ext);
1041773bda96SJonathan Lemon 	kfree(ext);
1042773bda96SJonathan Lemon }
1043773bda96SJonathan Lemon 
1044773bda96SJonathan Lemon static int
1045773bda96SJonathan Lemon ptp_ocp_register_ext(struct ptp_ocp *bp, struct ocp_resource *r)
1046773bda96SJonathan Lemon {
1047773bda96SJonathan Lemon 	struct pci_dev *pdev = bp->pdev;
1048773bda96SJonathan Lemon 	struct ptp_ocp_ext_src *ext;
1049773bda96SJonathan Lemon 	int err;
1050773bda96SJonathan Lemon 
1051773bda96SJonathan Lemon 	ext = kzalloc(sizeof(*ext), GFP_KERNEL);
1052773bda96SJonathan Lemon 	if (!ext)
1053773bda96SJonathan Lemon 		return -ENOMEM;
1054773bda96SJonathan Lemon 
1055773bda96SJonathan Lemon 	err = -EINVAL;
1056773bda96SJonathan Lemon 	ext->mem = ptp_ocp_get_mem(bp, r);
1057773bda96SJonathan Lemon 	if (!ext->mem)
1058773bda96SJonathan Lemon 		goto out;
1059773bda96SJonathan Lemon 
1060773bda96SJonathan Lemon 	ext->bp = bp;
1061773bda96SJonathan Lemon 	ext->info = r->extra;
1062773bda96SJonathan Lemon 	ext->irq_vec = r->irq_vec;
1063773bda96SJonathan Lemon 
1064773bda96SJonathan Lemon 	err = pci_request_irq(pdev, r->irq_vec, ext->info->irq_fcn, NULL,
106556ec4403SJonathan Lemon 			      ext, "ocp%d.%s", bp->id, r->name);
1066773bda96SJonathan Lemon 	if (err) {
1067773bda96SJonathan Lemon 		dev_err(&pdev->dev, "Could not get irq %d\n", r->irq_vec);
1068773bda96SJonathan Lemon 		goto out;
1069773bda96SJonathan Lemon 	}
1070773bda96SJonathan Lemon 
1071773bda96SJonathan Lemon 	bp_assign_entry(bp, r, ext);
1072773bda96SJonathan Lemon 
1073773bda96SJonathan Lemon 	return 0;
1074773bda96SJonathan Lemon 
1075773bda96SJonathan Lemon out:
1076773bda96SJonathan Lemon 	kfree(ext);
1077773bda96SJonathan Lemon 	return err;
1078773bda96SJonathan Lemon }
1079773bda96SJonathan Lemon 
1080773bda96SJonathan Lemon static int
1081773bda96SJonathan Lemon ptp_ocp_serial_line(struct ptp_ocp *bp, struct ocp_resource *r)
1082773bda96SJonathan Lemon {
1083773bda96SJonathan Lemon 	struct pci_dev *pdev = bp->pdev;
1084773bda96SJonathan Lemon 	struct uart_8250_port uart;
1085773bda96SJonathan Lemon 
1086773bda96SJonathan Lemon 	/* Setting UPF_IOREMAP and leaving port.membase unspecified lets
1087773bda96SJonathan Lemon 	 * the serial port device claim and release the pci resource.
1088773bda96SJonathan Lemon 	 */
1089773bda96SJonathan Lemon 	memset(&uart, 0, sizeof(uart));
1090773bda96SJonathan Lemon 	uart.port.dev = &pdev->dev;
1091773bda96SJonathan Lemon 	uart.port.iotype = UPIO_MEM;
1092773bda96SJonathan Lemon 	uart.port.regshift = 2;
1093773bda96SJonathan Lemon 	uart.port.mapbase = pci_resource_start(pdev, 0) + r->offset;
1094773bda96SJonathan Lemon 	uart.port.irq = pci_irq_vector(pdev, r->irq_vec);
1095773bda96SJonathan Lemon 	uart.port.uartclk = 50000000;
1096773bda96SJonathan Lemon 	uart.port.flags = UPF_FIXED_TYPE | UPF_IOREMAP;
1097773bda96SJonathan Lemon 	uart.port.type = PORT_16550A;
1098773bda96SJonathan Lemon 
1099773bda96SJonathan Lemon 	return serial8250_register_8250_port(&uart);
1100773bda96SJonathan Lemon }
1101773bda96SJonathan Lemon 
1102773bda96SJonathan Lemon static int
1103773bda96SJonathan Lemon ptp_ocp_register_serial(struct ptp_ocp *bp, struct ocp_resource *r)
1104773bda96SJonathan Lemon {
1105773bda96SJonathan Lemon 	int port;
1106773bda96SJonathan Lemon 
1107773bda96SJonathan Lemon 	port = ptp_ocp_serial_line(bp, r);
1108773bda96SJonathan Lemon 	if (port < 0)
1109773bda96SJonathan Lemon 		return port;
1110773bda96SJonathan Lemon 
1111773bda96SJonathan Lemon 	bp_assign_entry(bp, r, port);
1112773bda96SJonathan Lemon 
1113773bda96SJonathan Lemon 	return 0;
1114773bda96SJonathan Lemon }
1115773bda96SJonathan Lemon 
1116773bda96SJonathan Lemon static int
1117773bda96SJonathan Lemon ptp_ocp_register_mem(struct ptp_ocp *bp, struct ocp_resource *r)
1118773bda96SJonathan Lemon {
1119773bda96SJonathan Lemon 	void __iomem *mem;
1120773bda96SJonathan Lemon 
1121773bda96SJonathan Lemon 	mem = ptp_ocp_get_mem(bp, r);
1122773bda96SJonathan Lemon 	if (!mem)
1123773bda96SJonathan Lemon 		return -EINVAL;
1124773bda96SJonathan Lemon 
1125773bda96SJonathan Lemon 	bp_assign_entry(bp, r, mem);
1126773bda96SJonathan Lemon 
1127773bda96SJonathan Lemon 	return 0;
1128773bda96SJonathan Lemon }
1129773bda96SJonathan Lemon 
1130773bda96SJonathan Lemon /* FB specific board initializers; last "resource" registered. */
1131773bda96SJonathan Lemon static int
1132773bda96SJonathan Lemon ptp_ocp_fb_board_init(struct ptp_ocp *bp, struct ocp_resource *r)
1133773bda96SJonathan Lemon {
1134773bda96SJonathan Lemon 	bp->flash_start = 1024 * 4096;
1135773bda96SJonathan Lemon 
1136773bda96SJonathan Lemon 	return ptp_ocp_init_clock(bp);
1137773bda96SJonathan Lemon }
1138773bda96SJonathan Lemon 
113956ec4403SJonathan Lemon static bool
114056ec4403SJonathan Lemon ptp_ocp_allow_irq(struct ptp_ocp *bp, struct ocp_resource *r)
114156ec4403SJonathan Lemon {
114256ec4403SJonathan Lemon 	bool allow = !r->irq_vec || r->irq_vec < bp->n_irqs;
114356ec4403SJonathan Lemon 
114456ec4403SJonathan Lemon 	if (!allow)
114556ec4403SJonathan Lemon 		dev_err(&bp->pdev->dev, "irq %d out of range, skipping %s\n",
114656ec4403SJonathan Lemon 			r->irq_vec, r->name);
114756ec4403SJonathan Lemon 	return allow;
114856ec4403SJonathan Lemon }
114956ec4403SJonathan Lemon 
1150773bda96SJonathan Lemon static int
1151773bda96SJonathan Lemon ptp_ocp_register_resources(struct ptp_ocp *bp, kernel_ulong_t driver_data)
1152773bda96SJonathan Lemon {
1153773bda96SJonathan Lemon 	struct ocp_resource *r, *table;
1154773bda96SJonathan Lemon 	int err = 0;
1155773bda96SJonathan Lemon 
1156773bda96SJonathan Lemon 	table = (struct ocp_resource *)driver_data;
1157773bda96SJonathan Lemon 	for (r = table; r->setup; r++) {
115856ec4403SJonathan Lemon 		if (!ptp_ocp_allow_irq(bp, r))
115956ec4403SJonathan Lemon 			continue;
1160773bda96SJonathan Lemon 		err = r->setup(bp, r);
1161*bceff290SJonathan Lemon 		if (err) {
1162*bceff290SJonathan Lemon 			dev_err(&bp->pdev->dev,
1163*bceff290SJonathan Lemon 				"Could not register %s: err %d\n",
1164*bceff290SJonathan Lemon 				r->name, err);
1165773bda96SJonathan Lemon 			break;
1166773bda96SJonathan Lemon 		}
1167*bceff290SJonathan Lemon 	}
1168773bda96SJonathan Lemon 	return err;
1169773bda96SJonathan Lemon }
1170773bda96SJonathan Lemon 
1171773bda96SJonathan Lemon static ssize_t
1172773bda96SJonathan Lemon serialnum_show(struct device *dev, struct device_attribute *attr, char *buf)
1173773bda96SJonathan Lemon {
1174773bda96SJonathan Lemon 	struct ptp_ocp *bp = dev_get_drvdata(dev);
1175773bda96SJonathan Lemon 
1176773bda96SJonathan Lemon 	if (!bp->has_serial)
1177773bda96SJonathan Lemon 		ptp_ocp_get_serial_number(bp);
1178773bda96SJonathan Lemon 
1179773bda96SJonathan Lemon 	return sysfs_emit(buf, "%pM\n", bp->serial);
1180773bda96SJonathan Lemon }
1181773bda96SJonathan Lemon static DEVICE_ATTR_RO(serialnum);
1182773bda96SJonathan Lemon 
1183773bda96SJonathan Lemon static ssize_t
1184ef0cfb34SJonathan Lemon gnss_sync_show(struct device *dev, struct device_attribute *attr, char *buf)
1185773bda96SJonathan Lemon {
1186773bda96SJonathan Lemon 	struct ptp_ocp *bp = dev_get_drvdata(dev);
1187773bda96SJonathan Lemon 	ssize_t ret;
1188773bda96SJonathan Lemon 
1189ef0cfb34SJonathan Lemon 	if (bp->gnss_lost)
1190ef0cfb34SJonathan Lemon 		ret = sysfs_emit(buf, "LOST @ %ptT\n", &bp->gnss_lost);
1191773bda96SJonathan Lemon 	else
1192773bda96SJonathan Lemon 		ret = sysfs_emit(buf, "SYNC\n");
1193773bda96SJonathan Lemon 
1194773bda96SJonathan Lemon 	return ret;
1195773bda96SJonathan Lemon }
1196ef0cfb34SJonathan Lemon static DEVICE_ATTR_RO(gnss_sync);
1197773bda96SJonathan Lemon 
1198773bda96SJonathan Lemon static ssize_t
1199773bda96SJonathan Lemon clock_source_show(struct device *dev, struct device_attribute *attr, char *buf)
1200773bda96SJonathan Lemon {
1201773bda96SJonathan Lemon 	struct ptp_ocp *bp = dev_get_drvdata(dev);
1202773bda96SJonathan Lemon 	const char *p;
1203773bda96SJonathan Lemon 	u32 select;
1204773bda96SJonathan Lemon 
1205773bda96SJonathan Lemon 	select = ioread32(&bp->reg->select);
1206773bda96SJonathan Lemon 	p = ptp_ocp_clock_name_from_val(select >> 16);
1207773bda96SJonathan Lemon 
1208773bda96SJonathan Lemon 	return sysfs_emit(buf, "%s\n", p);
1209773bda96SJonathan Lemon }
1210773bda96SJonathan Lemon 
1211773bda96SJonathan Lemon static ssize_t
1212773bda96SJonathan Lemon clock_source_store(struct device *dev, struct device_attribute *attr,
1213773bda96SJonathan Lemon 		   const char *buf, size_t count)
1214773bda96SJonathan Lemon {
1215773bda96SJonathan Lemon 	struct ptp_ocp *bp = dev_get_drvdata(dev);
1216773bda96SJonathan Lemon 	unsigned long flags;
1217773bda96SJonathan Lemon 	int val;
1218773bda96SJonathan Lemon 
1219773bda96SJonathan Lemon 	val = ptp_ocp_clock_val_from_name(buf);
1220773bda96SJonathan Lemon 	if (val < 0)
1221773bda96SJonathan Lemon 		return val;
1222773bda96SJonathan Lemon 
1223773bda96SJonathan Lemon 	spin_lock_irqsave(&bp->lock, flags);
1224773bda96SJonathan Lemon 	iowrite32(val, &bp->reg->select);
1225773bda96SJonathan Lemon 	spin_unlock_irqrestore(&bp->lock, flags);
1226773bda96SJonathan Lemon 
1227773bda96SJonathan Lemon 	return count;
1228773bda96SJonathan Lemon }
1229773bda96SJonathan Lemon static DEVICE_ATTR_RW(clock_source);
1230773bda96SJonathan Lemon 
1231773bda96SJonathan Lemon static ssize_t
1232773bda96SJonathan Lemon available_clock_sources_show(struct device *dev,
1233773bda96SJonathan Lemon 			     struct device_attribute *attr, char *buf)
1234773bda96SJonathan Lemon {
1235773bda96SJonathan Lemon 	const char *clk;
1236773bda96SJonathan Lemon 	ssize_t count;
1237773bda96SJonathan Lemon 	int i;
1238773bda96SJonathan Lemon 
1239773bda96SJonathan Lemon 	count = 0;
1240773bda96SJonathan Lemon 	for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++) {
1241773bda96SJonathan Lemon 		clk = ptp_ocp_clock[i].name;
1242773bda96SJonathan Lemon 		count += sysfs_emit_at(buf, count, "%s ", clk);
1243773bda96SJonathan Lemon 	}
1244773bda96SJonathan Lemon 	if (count)
1245773bda96SJonathan Lemon 		count--;
1246773bda96SJonathan Lemon 	count += sysfs_emit_at(buf, count, "\n");
1247773bda96SJonathan Lemon 	return count;
1248773bda96SJonathan Lemon }
1249773bda96SJonathan Lemon static DEVICE_ATTR_RO(available_clock_sources);
1250773bda96SJonathan Lemon 
1251773bda96SJonathan Lemon static struct attribute *timecard_attrs[] = {
1252773bda96SJonathan Lemon 	&dev_attr_serialnum.attr,
1253ef0cfb34SJonathan Lemon 	&dev_attr_gnss_sync.attr,
1254773bda96SJonathan Lemon 	&dev_attr_clock_source.attr,
1255773bda96SJonathan Lemon 	&dev_attr_available_clock_sources.attr,
1256773bda96SJonathan Lemon 	NULL,
1257773bda96SJonathan Lemon };
1258773bda96SJonathan Lemon ATTRIBUTE_GROUPS(timecard);
1259773bda96SJonathan Lemon 
1260773bda96SJonathan Lemon static void
1261773bda96SJonathan Lemon ptp_ocp_dev_release(struct device *dev)
1262773bda96SJonathan Lemon {
1263773bda96SJonathan Lemon 	struct ptp_ocp *bp = dev_get_drvdata(dev);
1264773bda96SJonathan Lemon 
1265773bda96SJonathan Lemon 	mutex_lock(&ptp_ocp_lock);
1266773bda96SJonathan Lemon 	idr_remove(&ptp_ocp_idr, bp->id);
1267773bda96SJonathan Lemon 	mutex_unlock(&ptp_ocp_lock);
1268773bda96SJonathan Lemon }
1269773bda96SJonathan Lemon 
1270773bda96SJonathan Lemon static int
1271773bda96SJonathan Lemon ptp_ocp_device_init(struct ptp_ocp *bp, struct pci_dev *pdev)
1272773bda96SJonathan Lemon {
1273773bda96SJonathan Lemon 	int err;
1274773bda96SJonathan Lemon 
1275773bda96SJonathan Lemon 	mutex_lock(&ptp_ocp_lock);
1276773bda96SJonathan Lemon 	err = idr_alloc(&ptp_ocp_idr, bp, 0, 0, GFP_KERNEL);
1277773bda96SJonathan Lemon 	mutex_unlock(&ptp_ocp_lock);
1278773bda96SJonathan Lemon 	if (err < 0) {
1279773bda96SJonathan Lemon 		dev_err(&pdev->dev, "idr_alloc failed: %d\n", err);
1280773bda96SJonathan Lemon 		return err;
1281773bda96SJonathan Lemon 	}
1282773bda96SJonathan Lemon 	bp->id = err;
1283773bda96SJonathan Lemon 
1284773bda96SJonathan Lemon 	bp->ptp_info = ptp_ocp_clock_info;
1285773bda96SJonathan Lemon 	spin_lock_init(&bp->lock);
1286ef0cfb34SJonathan Lemon 	bp->gnss_port = -1;
1287773bda96SJonathan Lemon 	bp->mac_port = -1;
1288773bda96SJonathan Lemon 	bp->pdev = pdev;
1289773bda96SJonathan Lemon 
1290773bda96SJonathan Lemon 	device_initialize(&bp->dev);
1291773bda96SJonathan Lemon 	dev_set_name(&bp->dev, "ocp%d", bp->id);
1292773bda96SJonathan Lemon 	bp->dev.class = &timecard_class;
1293773bda96SJonathan Lemon 	bp->dev.parent = &pdev->dev;
1294773bda96SJonathan Lemon 	bp->dev.release = ptp_ocp_dev_release;
1295773bda96SJonathan Lemon 	dev_set_drvdata(&bp->dev, bp);
1296773bda96SJonathan Lemon 
1297773bda96SJonathan Lemon 	err = device_add(&bp->dev);
1298773bda96SJonathan Lemon 	if (err) {
1299773bda96SJonathan Lemon 		dev_err(&bp->dev, "device add failed: %d\n", err);
1300773bda96SJonathan Lemon 		goto out;
1301773bda96SJonathan Lemon 	}
1302773bda96SJonathan Lemon 
1303773bda96SJonathan Lemon 	pci_set_drvdata(pdev, bp);
1304773bda96SJonathan Lemon 
1305773bda96SJonathan Lemon 	return 0;
1306773bda96SJonathan Lemon 
1307773bda96SJonathan Lemon out:
1308773bda96SJonathan Lemon 	ptp_ocp_dev_release(&bp->dev);
1309d12f23faSJonathan Lemon 	put_device(&bp->dev);
1310773bda96SJonathan Lemon 	return err;
1311773bda96SJonathan Lemon }
1312773bda96SJonathan Lemon 
1313773bda96SJonathan Lemon static void
1314773bda96SJonathan Lemon ptp_ocp_symlink(struct ptp_ocp *bp, struct device *child, const char *link)
1315773bda96SJonathan Lemon {
1316773bda96SJonathan Lemon 	struct device *dev = &bp->dev;
1317773bda96SJonathan Lemon 
1318773bda96SJonathan Lemon 	if (sysfs_create_link(&dev->kobj, &child->kobj, link))
1319773bda96SJonathan Lemon 		dev_err(dev, "%s symlink failed\n", link);
1320773bda96SJonathan Lemon }
1321773bda96SJonathan Lemon 
1322773bda96SJonathan Lemon static void
1323773bda96SJonathan Lemon ptp_ocp_link_child(struct ptp_ocp *bp, const char *name, const char *link)
1324773bda96SJonathan Lemon {
1325773bda96SJonathan Lemon 	struct device *dev, *child;
1326773bda96SJonathan Lemon 
1327773bda96SJonathan Lemon 	dev = &bp->pdev->dev;
1328773bda96SJonathan Lemon 
1329773bda96SJonathan Lemon 	child = device_find_child_by_name(dev, name);
1330773bda96SJonathan Lemon 	if (!child) {
1331773bda96SJonathan Lemon 		dev_err(dev, "Could not find device %s\n", name);
1332773bda96SJonathan Lemon 		return;
1333773bda96SJonathan Lemon 	}
1334773bda96SJonathan Lemon 
1335773bda96SJonathan Lemon 	ptp_ocp_symlink(bp, child, link);
1336773bda96SJonathan Lemon 	put_device(child);
1337773bda96SJonathan Lemon }
1338773bda96SJonathan Lemon 
1339773bda96SJonathan Lemon static int
1340773bda96SJonathan Lemon ptp_ocp_complete(struct ptp_ocp *bp)
1341773bda96SJonathan Lemon {
1342773bda96SJonathan Lemon 	struct pps_device *pps;
1343773bda96SJonathan Lemon 	char buf[32];
1344773bda96SJonathan Lemon 
1345ef0cfb34SJonathan Lemon 	if (bp->gnss_port != -1) {
1346ef0cfb34SJonathan Lemon 		sprintf(buf, "ttyS%d", bp->gnss_port);
1347ef0cfb34SJonathan Lemon 		ptp_ocp_link_child(bp, buf, "ttyGNSS");
1348773bda96SJonathan Lemon 	}
1349773bda96SJonathan Lemon 	if (bp->mac_port != -1) {
1350773bda96SJonathan Lemon 		sprintf(buf, "ttyS%d", bp->mac_port);
1351773bda96SJonathan Lemon 		ptp_ocp_link_child(bp, buf, "ttyMAC");
1352773bda96SJonathan Lemon 	}
1353773bda96SJonathan Lemon 	sprintf(buf, "ptp%d", ptp_clock_index(bp->ptp));
1354773bda96SJonathan Lemon 	ptp_ocp_link_child(bp, buf, "ptp");
1355773bda96SJonathan Lemon 
1356773bda96SJonathan Lemon 	pps = pps_lookup_dev(bp->ptp);
1357773bda96SJonathan Lemon 	if (pps)
1358773bda96SJonathan Lemon 		ptp_ocp_symlink(bp, pps->dev, "pps");
1359773bda96SJonathan Lemon 
1360773bda96SJonathan Lemon 	if (device_add_groups(&bp->dev, timecard_groups))
1361773bda96SJonathan Lemon 		pr_err("device add groups failed\n");
1362773bda96SJonathan Lemon 
1363773bda96SJonathan Lemon 	return 0;
1364773bda96SJonathan Lemon }
1365773bda96SJonathan Lemon 
1366773bda96SJonathan Lemon static void
1367773bda96SJonathan Lemon ptp_ocp_resource_summary(struct ptp_ocp *bp)
1368773bda96SJonathan Lemon {
1369773bda96SJonathan Lemon 	struct device *dev = &bp->pdev->dev;
1370773bda96SJonathan Lemon 
1371773bda96SJonathan Lemon 	if (bp->image) {
1372773bda96SJonathan Lemon 		u32 ver = ioread32(&bp->image->version);
1373773bda96SJonathan Lemon 
1374773bda96SJonathan Lemon 		dev_info(dev, "version %x\n", ver);
1375773bda96SJonathan Lemon 		if (ver & 0xffff)
1376773bda96SJonathan Lemon 			dev_info(dev, "regular image, version %d\n",
1377773bda96SJonathan Lemon 				 ver & 0xffff);
1378773bda96SJonathan Lemon 		else
1379773bda96SJonathan Lemon 			dev_info(dev, "golden image, version %d\n",
1380773bda96SJonathan Lemon 				 ver >> 16);
1381773bda96SJonathan Lemon 	}
1382ef0cfb34SJonathan Lemon 	if (bp->gnss_port != -1)
1383ef0cfb34SJonathan Lemon 		dev_info(dev, "GNSS @ /dev/ttyS%d 115200\n", bp->gnss_port);
1384773bda96SJonathan Lemon 	if (bp->mac_port != -1)
1385773bda96SJonathan Lemon 		dev_info(dev, "MAC @ /dev/ttyS%d   57600\n", bp->mac_port);
1386773bda96SJonathan Lemon }
1387773bda96SJonathan Lemon 
1388773bda96SJonathan Lemon static void
1389773bda96SJonathan Lemon ptp_ocp_detach_sysfs(struct ptp_ocp *bp)
1390773bda96SJonathan Lemon {
1391773bda96SJonathan Lemon 	struct device *dev = &bp->dev;
1392773bda96SJonathan Lemon 
1393ef0cfb34SJonathan Lemon 	sysfs_remove_link(&dev->kobj, "ttyGNSS");
1394773bda96SJonathan Lemon 	sysfs_remove_link(&dev->kobj, "ttyMAC");
1395773bda96SJonathan Lemon 	sysfs_remove_link(&dev->kobj, "ptp");
1396773bda96SJonathan Lemon 	sysfs_remove_link(&dev->kobj, "pps");
1397773bda96SJonathan Lemon 	device_remove_groups(dev, timecard_groups);
1398773bda96SJonathan Lemon }
1399773bda96SJonathan Lemon 
1400773bda96SJonathan Lemon static void
1401773bda96SJonathan Lemon ptp_ocp_detach(struct ptp_ocp *bp)
1402773bda96SJonathan Lemon {
1403773bda96SJonathan Lemon 	ptp_ocp_detach_sysfs(bp);
1404773bda96SJonathan Lemon 	if (timer_pending(&bp->watchdog))
1405773bda96SJonathan Lemon 		del_timer_sync(&bp->watchdog);
1406773bda96SJonathan Lemon 	if (bp->ts0)
1407773bda96SJonathan Lemon 		ptp_ocp_unregister_ext(bp->ts0);
1408773bda96SJonathan Lemon 	if (bp->ts1)
1409773bda96SJonathan Lemon 		ptp_ocp_unregister_ext(bp->ts1);
1410773bda96SJonathan Lemon 	if (bp->pps)
1411773bda96SJonathan Lemon 		ptp_ocp_unregister_ext(bp->pps);
1412ef0cfb34SJonathan Lemon 	if (bp->gnss_port != -1)
1413ef0cfb34SJonathan Lemon 		serial8250_unregister_port(bp->gnss_port);
1414773bda96SJonathan Lemon 	if (bp->mac_port != -1)
1415773bda96SJonathan Lemon 		serial8250_unregister_port(bp->mac_port);
1416773bda96SJonathan Lemon 	if (bp->spi_flash)
1417773bda96SJonathan Lemon 		platform_device_unregister(bp->spi_flash);
1418773bda96SJonathan Lemon 	if (bp->i2c_ctrl)
1419773bda96SJonathan Lemon 		platform_device_unregister(bp->i2c_ctrl);
1420773bda96SJonathan Lemon 	if (bp->i2c_clk)
1421773bda96SJonathan Lemon 		clk_hw_unregister_fixed_rate(bp->i2c_clk);
1422773bda96SJonathan Lemon 	if (bp->n_irqs)
1423773bda96SJonathan Lemon 		pci_free_irq_vectors(bp->pdev);
1424773bda96SJonathan Lemon 	if (bp->ptp)
1425773bda96SJonathan Lemon 		ptp_clock_unregister(bp->ptp);
1426773bda96SJonathan Lemon 	device_unregister(&bp->dev);
1427773bda96SJonathan Lemon }
1428773bda96SJonathan Lemon 
1429a7e1abadSJonathan Lemon static int
1430a7e1abadSJonathan Lemon ptp_ocp_probe(struct pci_dev *pdev, const struct pci_device_id *id)
1431a7e1abadSJonathan Lemon {
1432773bda96SJonathan Lemon 	struct devlink *devlink;
1433a7e1abadSJonathan Lemon 	struct ptp_ocp *bp;
1434a7e1abadSJonathan Lemon 	int err;
1435a7e1abadSJonathan Lemon 
1436919d13a7SLeon Romanovsky 	devlink = devlink_alloc(&ptp_ocp_devlink_ops, sizeof(*bp), &pdev->dev);
1437773bda96SJonathan Lemon 	if (!devlink) {
1438773bda96SJonathan Lemon 		dev_err(&pdev->dev, "devlink_alloc failed\n");
1439a7e1abadSJonathan Lemon 		return -ENOMEM;
1440773bda96SJonathan Lemon 	}
1441773bda96SJonathan Lemon 
1442919d13a7SLeon Romanovsky 	err = devlink_register(devlink);
1443773bda96SJonathan Lemon 	if (err)
1444773bda96SJonathan Lemon 		goto out_free;
1445a7e1abadSJonathan Lemon 
1446a7e1abadSJonathan Lemon 	err = pci_enable_device(pdev);
1447a7e1abadSJonathan Lemon 	if (err) {
1448a7e1abadSJonathan Lemon 		dev_err(&pdev->dev, "pci_enable_device\n");
1449773bda96SJonathan Lemon 		goto out_unregister;
1450a7e1abadSJonathan Lemon 	}
1451a7e1abadSJonathan Lemon 
1452773bda96SJonathan Lemon 	bp = devlink_priv(devlink);
1453773bda96SJonathan Lemon 	err = ptp_ocp_device_init(bp, pdev);
1454773bda96SJonathan Lemon 	if (err)
1455d9fdbf13SJonathan Lemon 		goto out_disable;
1456a7e1abadSJonathan Lemon 
1457773bda96SJonathan Lemon 	/* compat mode.
1458773bda96SJonathan Lemon 	 * Older FPGA firmware only returns 2 irq's.
1459773bda96SJonathan Lemon 	 * allow this - if not all of the IRQ's are returned, skip the
1460773bda96SJonathan Lemon 	 * extra devices and just register the clock.
1461773bda96SJonathan Lemon 	 */
1462773bda96SJonathan Lemon 	err = pci_alloc_irq_vectors(pdev, 1, 10, PCI_IRQ_MSI | PCI_IRQ_MSIX);
1463773bda96SJonathan Lemon 	if (err < 0) {
1464773bda96SJonathan Lemon 		dev_err(&pdev->dev, "alloc_irq_vectors err: %d\n", err);
1465773bda96SJonathan Lemon 		goto out;
1466a7e1abadSJonathan Lemon 	}
1467773bda96SJonathan Lemon 	bp->n_irqs = err;
1468773bda96SJonathan Lemon 	pci_set_master(pdev);
1469a7e1abadSJonathan Lemon 
1470773bda96SJonathan Lemon 	err = ptp_ocp_register_resources(bp, id->driver_data);
1471a7e1abadSJonathan Lemon 	if (err)
1472a7e1abadSJonathan Lemon 		goto out;
1473a7e1abadSJonathan Lemon 
1474a7e1abadSJonathan Lemon 	bp->ptp = ptp_clock_register(&bp->ptp_info, &pdev->dev);
1475a7e1abadSJonathan Lemon 	if (IS_ERR(bp->ptp)) {
1476a7e1abadSJonathan Lemon 		err = PTR_ERR(bp->ptp);
1477773bda96SJonathan Lemon 		dev_err(&pdev->dev, "ptp_clock_register: %d\n", err);
1478773bda96SJonathan Lemon 		bp->ptp = NULL;
1479a7e1abadSJonathan Lemon 		goto out;
1480a7e1abadSJonathan Lemon 	}
1481a7e1abadSJonathan Lemon 
1482773bda96SJonathan Lemon 	err = ptp_ocp_complete(bp);
1483773bda96SJonathan Lemon 	if (err)
1484773bda96SJonathan Lemon 		goto out;
1485773bda96SJonathan Lemon 
1486a7e1abadSJonathan Lemon 	ptp_ocp_info(bp);
1487773bda96SJonathan Lemon 	ptp_ocp_resource_summary(bp);
1488a7e1abadSJonathan Lemon 
1489a7e1abadSJonathan Lemon 	return 0;
1490a7e1abadSJonathan Lemon 
1491a7e1abadSJonathan Lemon out:
1492773bda96SJonathan Lemon 	ptp_ocp_detach(bp);
1493773bda96SJonathan Lemon 	pci_set_drvdata(pdev, NULL);
1494d9fdbf13SJonathan Lemon out_disable:
1495d9fdbf13SJonathan Lemon 	pci_disable_device(pdev);
1496773bda96SJonathan Lemon out_unregister:
1497919d13a7SLeon Romanovsky 	devlink_unregister(devlink);
1498a7e1abadSJonathan Lemon out_free:
1499773bda96SJonathan Lemon 	devlink_free(devlink);
1500a7e1abadSJonathan Lemon 
1501a7e1abadSJonathan Lemon 	return err;
1502a7e1abadSJonathan Lemon }
1503a7e1abadSJonathan Lemon 
1504a7e1abadSJonathan Lemon static void
1505a7e1abadSJonathan Lemon ptp_ocp_remove(struct pci_dev *pdev)
1506a7e1abadSJonathan Lemon {
1507a7e1abadSJonathan Lemon 	struct ptp_ocp *bp = pci_get_drvdata(pdev);
1508773bda96SJonathan Lemon 	struct devlink *devlink = priv_to_devlink(bp);
1509a7e1abadSJonathan Lemon 
1510773bda96SJonathan Lemon 	ptp_ocp_detach(bp);
1511a7e1abadSJonathan Lemon 	pci_set_drvdata(pdev, NULL);
1512d9fdbf13SJonathan Lemon 	pci_disable_device(pdev);
1513773bda96SJonathan Lemon 
1514919d13a7SLeon Romanovsky 	devlink_unregister(devlink);
1515773bda96SJonathan Lemon 	devlink_free(devlink);
1516a7e1abadSJonathan Lemon }
1517a7e1abadSJonathan Lemon 
1518a7e1abadSJonathan Lemon static struct pci_driver ptp_ocp_driver = {
1519a7e1abadSJonathan Lemon 	.name		= KBUILD_MODNAME,
1520a7e1abadSJonathan Lemon 	.id_table	= ptp_ocp_pcidev_id,
1521a7e1abadSJonathan Lemon 	.probe		= ptp_ocp_probe,
1522a7e1abadSJonathan Lemon 	.remove		= ptp_ocp_remove,
1523a7e1abadSJonathan Lemon };
1524a7e1abadSJonathan Lemon 
1525773bda96SJonathan Lemon static int
1526773bda96SJonathan Lemon ptp_ocp_i2c_notifier_call(struct notifier_block *nb,
1527773bda96SJonathan Lemon 			  unsigned long action, void *data)
1528773bda96SJonathan Lemon {
1529773bda96SJonathan Lemon 	struct device *dev, *child = data;
1530773bda96SJonathan Lemon 	struct ptp_ocp *bp;
1531773bda96SJonathan Lemon 	bool add;
1532773bda96SJonathan Lemon 
1533773bda96SJonathan Lemon 	switch (action) {
1534773bda96SJonathan Lemon 	case BUS_NOTIFY_ADD_DEVICE:
1535773bda96SJonathan Lemon 	case BUS_NOTIFY_DEL_DEVICE:
1536773bda96SJonathan Lemon 		add = action == BUS_NOTIFY_ADD_DEVICE;
1537773bda96SJonathan Lemon 		break;
1538773bda96SJonathan Lemon 	default:
1539773bda96SJonathan Lemon 		return 0;
1540773bda96SJonathan Lemon 	}
1541773bda96SJonathan Lemon 
1542773bda96SJonathan Lemon 	if (!i2c_verify_adapter(child))
1543773bda96SJonathan Lemon 		return 0;
1544773bda96SJonathan Lemon 
1545773bda96SJonathan Lemon 	dev = child;
1546773bda96SJonathan Lemon 	while ((dev = dev->parent))
1547773bda96SJonathan Lemon 		if (dev->driver && !strcmp(dev->driver->name, KBUILD_MODNAME))
1548773bda96SJonathan Lemon 			goto found;
1549773bda96SJonathan Lemon 	return 0;
1550773bda96SJonathan Lemon 
1551773bda96SJonathan Lemon found:
1552773bda96SJonathan Lemon 	bp = dev_get_drvdata(dev);
1553773bda96SJonathan Lemon 	if (add)
1554773bda96SJonathan Lemon 		ptp_ocp_symlink(bp, child, "i2c");
1555773bda96SJonathan Lemon 	else
1556773bda96SJonathan Lemon 		sysfs_remove_link(&bp->dev.kobj, "i2c");
1557773bda96SJonathan Lemon 
1558773bda96SJonathan Lemon 	return 0;
1559773bda96SJonathan Lemon }
1560773bda96SJonathan Lemon 
1561773bda96SJonathan Lemon static struct notifier_block ptp_ocp_i2c_notifier = {
1562773bda96SJonathan Lemon 	.notifier_call = ptp_ocp_i2c_notifier_call,
1563773bda96SJonathan Lemon };
1564773bda96SJonathan Lemon 
1565a7e1abadSJonathan Lemon static int __init
1566a7e1abadSJonathan Lemon ptp_ocp_init(void)
1567a7e1abadSJonathan Lemon {
1568773bda96SJonathan Lemon 	const char *what;
1569a7e1abadSJonathan Lemon 	int err;
1570a7e1abadSJonathan Lemon 
1571773bda96SJonathan Lemon 	what = "timecard class";
1572773bda96SJonathan Lemon 	err = class_register(&timecard_class);
1573773bda96SJonathan Lemon 	if (err)
1574773bda96SJonathan Lemon 		goto out;
1575773bda96SJonathan Lemon 
1576773bda96SJonathan Lemon 	what = "i2c notifier";
1577773bda96SJonathan Lemon 	err = bus_register_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier);
1578773bda96SJonathan Lemon 	if (err)
1579773bda96SJonathan Lemon 		goto out_notifier;
1580773bda96SJonathan Lemon 
1581773bda96SJonathan Lemon 	what = "ptp_ocp driver";
1582a7e1abadSJonathan Lemon 	err = pci_register_driver(&ptp_ocp_driver);
1583773bda96SJonathan Lemon 	if (err)
1584773bda96SJonathan Lemon 		goto out_register;
1585773bda96SJonathan Lemon 
1586773bda96SJonathan Lemon 	return 0;
1587773bda96SJonathan Lemon 
1588773bda96SJonathan Lemon out_register:
1589773bda96SJonathan Lemon 	bus_unregister_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier);
1590773bda96SJonathan Lemon out_notifier:
1591773bda96SJonathan Lemon 	class_unregister(&timecard_class);
1592773bda96SJonathan Lemon out:
1593773bda96SJonathan Lemon 	pr_err(KBUILD_MODNAME ": failed to register %s: %d\n", what, err);
1594a7e1abadSJonathan Lemon 	return err;
1595a7e1abadSJonathan Lemon }
1596a7e1abadSJonathan Lemon 
1597a7e1abadSJonathan Lemon static void __exit
1598a7e1abadSJonathan Lemon ptp_ocp_fini(void)
1599a7e1abadSJonathan Lemon {
1600773bda96SJonathan Lemon 	bus_unregister_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier);
1601a7e1abadSJonathan Lemon 	pci_unregister_driver(&ptp_ocp_driver);
1602773bda96SJonathan Lemon 	class_unregister(&timecard_class);
1603a7e1abadSJonathan Lemon }
1604a7e1abadSJonathan Lemon 
1605a7e1abadSJonathan Lemon module_init(ptp_ocp_init);
1606a7e1abadSJonathan Lemon module_exit(ptp_ocp_fini);
1607a7e1abadSJonathan Lemon 
1608a7e1abadSJonathan Lemon MODULE_DESCRIPTION("OpenCompute TimeCard driver");
1609a7e1abadSJonathan Lemon MODULE_LICENSE("GPL v2");
1610