File Index
Files and directories
Sign in
FILE

omap_hdq.c

File preview with syntax highlighting.

linux-6.19.14/drivers/w1/masters/omap_hdq.c C
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (C) 2007,2012 Texas Instruments, Inc.
  4 */
  5#include <linux/kernel.h>
  6#include <linux/module.h>
  7#include <linux/platform_device.h>
  8#include <linux/interrupt.h>
  9#include <linux/slab.h>
 10#include <linux/err.h>
 11#include <linux/io.h>
 12#include <linux/sched.h>
 13#include <linux/pm_runtime.h>
 14#include <linux/of.h>
 15
 16#include <linux/w1.h>
 17
 18#define	MOD_NAME	"OMAP_HDQ:"
 19
 20#define OMAP_HDQ_REVISION			0x00
 21#define OMAP_HDQ_TX_DATA			0x04
 22#define OMAP_HDQ_RX_DATA			0x08
 23#define OMAP_HDQ_CTRL_STATUS			0x0c
 24#define OMAP_HDQ_CTRL_STATUS_SINGLE		BIT(7)
 25#define OMAP_HDQ_CTRL_STATUS_INTERRUPTMASK	BIT(6)
 26#define OMAP_HDQ_CTRL_STATUS_CLOCKENABLE	BIT(5)
 27#define OMAP_HDQ_CTRL_STATUS_GO                 BIT(4)
 28#define OMAP_HDQ_CTRL_STATUS_PRESENCE		BIT(3)
 29#define OMAP_HDQ_CTRL_STATUS_INITIALIZATION	BIT(2)
 30#define OMAP_HDQ_CTRL_STATUS_DIR		BIT(1)
 31#define OMAP_HDQ_INT_STATUS			0x10
 32#define OMAP_HDQ_INT_STATUS_TXCOMPLETE		BIT(2)
 33#define OMAP_HDQ_INT_STATUS_RXCOMPLETE		BIT(1)
 34#define OMAP_HDQ_INT_STATUS_TIMEOUT		BIT(0)
 35
 36#define OMAP_HDQ_FLAG_CLEAR			0
 37#define OMAP_HDQ_FLAG_SET			1
 38#define OMAP_HDQ_TIMEOUT			(HZ/5)
 39
 40#define OMAP_HDQ_MAX_USER			4
 41
 42static DECLARE_WAIT_QUEUE_HEAD(hdq_wait_queue);
 43
 44static int w1_id;
 45module_param(w1_id, int, 0400);
 46MODULE_PARM_DESC(w1_id, "1-wire id for the slave detection in HDQ mode");
 47
 48struct hdq_data {
 49	struct device		*dev;
 50	void __iomem		*hdq_base;
 51	/* lock read/write/break operations */
 52	struct  mutex		hdq_mutex;
 53	/* interrupt status and a lock for it */
 54	u8			hdq_irqstatus;
 55	spinlock_t		hdq_spinlock;
 56	/* mode: 0-HDQ 1-W1 */
 57	int                     mode;
 58
 59};
 60
 61/* HDQ register I/O routines */
 62static inline u8 hdq_reg_in(struct hdq_data *hdq_data, u32 offset)
 63{
 64	return __raw_readl(hdq_data->hdq_base + offset);
 65}
 66
 67static inline void hdq_reg_out(struct hdq_data *hdq_data, u32 offset, u8 val)
 68{
 69	__raw_writel(val, hdq_data->hdq_base + offset);
 70}
 71
 72static inline u8 hdq_reg_merge(struct hdq_data *hdq_data, u32 offset,
 73			u8 val, u8 mask)
 74{
 75	u8 new_val = (__raw_readl(hdq_data->hdq_base + offset) & ~mask)
 76			| (val & mask);
 77	__raw_writel(new_val, hdq_data->hdq_base + offset);
 78
 79	return new_val;
 80}
 81
 82/*
 83 * Wait for one or more bits in flag change.
 84 * HDQ_FLAG_SET: wait until any bit in the flag is set.
 85 * HDQ_FLAG_CLEAR: wait until all bits in the flag are cleared.
 86 * return 0 on success and -ETIMEDOUT in the case of timeout.
 87 */
 88static int hdq_wait_for_flag(struct hdq_data *hdq_data, u32 offset,
 89		u8 flag, u8 flag_set, u8 *status)
 90{
 91	int ret = 0;
 92	unsigned long timeout = jiffies + OMAP_HDQ_TIMEOUT;
 93
 94	if (flag_set == OMAP_HDQ_FLAG_CLEAR) {
 95		/* wait for the flag clear */
 96		while (((*status = hdq_reg_in(hdq_data, offset)) & flag)
 97			&& time_before(jiffies, timeout)) {
 98			schedule_timeout_uninterruptible(1);
 99		}
100		if (*status & flag)
101			ret = -ETIMEDOUT;
102	} else if (flag_set == OMAP_HDQ_FLAG_SET) {
103		/* wait for the flag set */
104		while (!((*status = hdq_reg_in(hdq_data, offset)) & flag)
105			&& time_before(jiffies, timeout)) {
106			schedule_timeout_uninterruptible(1);
107		}
108		if (!(*status & flag))
109			ret = -ETIMEDOUT;
110	} else
111		return -EINVAL;
112
113	return ret;
114}
115
116/* Clear saved irqstatus after using an interrupt */
117static u8 hdq_reset_irqstatus(struct hdq_data *hdq_data, u8 bits)
118{
119	unsigned long irqflags;
120	u8 status;
121
122	spin_lock_irqsave(&hdq_data->hdq_spinlock, irqflags);
123	status = hdq_data->hdq_irqstatus;
124	/* this is a read-modify-write */
125	hdq_data->hdq_irqstatus &= ~bits;
126	spin_unlock_irqrestore(&hdq_data->hdq_spinlock, irqflags);
127
128	return status;
129}
130
131/* write out a byte and fill *status with HDQ_INT_STATUS */
132static int hdq_write_byte(struct hdq_data *hdq_data, u8 val, u8 *status)
133{
134	int ret;
135	u8 tmp_status;
136
137	ret = mutex_lock_interruptible(&hdq_data->hdq_mutex);
138	if (ret < 0) {
139		ret = -EINTR;
140		goto rtn;
141	}
142
143	if (hdq_data->hdq_irqstatus)
144		dev_err(hdq_data->dev, "TX irqstatus not cleared (%02x)\n",
145			hdq_data->hdq_irqstatus);
146
147	*status = 0;
148
149	hdq_reg_out(hdq_data, OMAP_HDQ_TX_DATA, val);
150
151	/* set the GO bit */
152	hdq_reg_merge(hdq_data, OMAP_HDQ_CTRL_STATUS, OMAP_HDQ_CTRL_STATUS_GO,
153		OMAP_HDQ_CTRL_STATUS_DIR | OMAP_HDQ_CTRL_STATUS_GO);
154	/* wait for the TXCOMPLETE bit */
155	ret = wait_event_timeout(hdq_wait_queue,
156		(hdq_data->hdq_irqstatus & OMAP_HDQ_INT_STATUS_TXCOMPLETE),
157		OMAP_HDQ_TIMEOUT);
158	*status = hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_TXCOMPLETE);
159	if (ret == 0) {
160		dev_dbg(hdq_data->dev, "TX wait elapsed\n");
161		ret = -ETIMEDOUT;
162		goto out;
163	}
164
165	/* check irqstatus */
166	if (!(*status & OMAP_HDQ_INT_STATUS_TXCOMPLETE)) {
167		dev_dbg(hdq_data->dev, "timeout waiting for"
168			" TXCOMPLETE/RXCOMPLETE, %x\n", *status);
169		ret = -ETIMEDOUT;
170		goto out;
171	}
172
173	/* wait for the GO bit return to zero */
174	ret = hdq_wait_for_flag(hdq_data, OMAP_HDQ_CTRL_STATUS,
175			OMAP_HDQ_CTRL_STATUS_GO,
176			OMAP_HDQ_FLAG_CLEAR, &tmp_status);
177	if (ret) {
178		dev_dbg(hdq_data->dev, "timeout waiting GO bit"
179			" return to zero, %x\n", tmp_status);
180	}
181
182out:
183	mutex_unlock(&hdq_data->hdq_mutex);
184rtn:
185	return ret;
186}
187
188/* HDQ Interrupt service routine */
189static irqreturn_t hdq_isr(int irq, void *_hdq)
190{
191	struct hdq_data *hdq_data = _hdq;
192	unsigned long irqflags;
193
194	spin_lock_irqsave(&hdq_data->hdq_spinlock, irqflags);
195	hdq_data->hdq_irqstatus |= hdq_reg_in(hdq_data, OMAP_HDQ_INT_STATUS);
196	spin_unlock_irqrestore(&hdq_data->hdq_spinlock, irqflags);
197	dev_dbg(hdq_data->dev, "hdq_isr: %x\n", hdq_data->hdq_irqstatus);
198
199	if (hdq_data->hdq_irqstatus &
200		(OMAP_HDQ_INT_STATUS_TXCOMPLETE | OMAP_HDQ_INT_STATUS_RXCOMPLETE
201		| OMAP_HDQ_INT_STATUS_TIMEOUT)) {
202		/* wake up sleeping process */
203		wake_up(&hdq_wait_queue);
204	}
205
206	return IRQ_HANDLED;
207}
208
209/* W1 search callback function  in HDQ mode */
210static void omap_w1_search_bus(void *_hdq, struct w1_master *master_dev,
211		u8 search_type, w1_slave_found_callback slave_found)
212{
213	u64 module_id, rn_le, cs, id;
214
215	if (w1_id)
216		module_id = w1_id;
217	else
218		module_id = 0x1;
219
220	rn_le = cpu_to_le64(module_id);
221	/*
222	 * HDQ might not obey truly the 1-wire spec.
223	 * So calculate CRC based on module parameter.
224	 */
225	cs = w1_calc_crc8((u8 *)&rn_le, 7);
226	id = (cs << 56) | module_id;
227
228	slave_found(master_dev, id);
229}
230
231/* Issue break pulse to the device */
232static int omap_hdq_break(struct hdq_data *hdq_data)
233{
234	int ret = 0;
235	u8 tmp_status;
236
237	ret = mutex_lock_interruptible(&hdq_data->hdq_mutex);
238	if (ret < 0) {
239		dev_dbg(hdq_data->dev, "Could not acquire mutex\n");
240		ret = -EINTR;
241		goto rtn;
242	}
243
244	if (hdq_data->hdq_irqstatus)
245		dev_err(hdq_data->dev, "break irqstatus not cleared (%02x)\n",
246			hdq_data->hdq_irqstatus);
247
248	/* set the INIT and GO bit */
249	hdq_reg_merge(hdq_data, OMAP_HDQ_CTRL_STATUS,
250		OMAP_HDQ_CTRL_STATUS_INITIALIZATION | OMAP_HDQ_CTRL_STATUS_GO,
251		OMAP_HDQ_CTRL_STATUS_DIR | OMAP_HDQ_CTRL_STATUS_INITIALIZATION |
252		OMAP_HDQ_CTRL_STATUS_GO);
253
254	/* wait for the TIMEOUT bit */
255	ret = wait_event_timeout(hdq_wait_queue,
256		(hdq_data->hdq_irqstatus & OMAP_HDQ_INT_STATUS_TIMEOUT),
257		OMAP_HDQ_TIMEOUT);
258	tmp_status = hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_TIMEOUT);
259	if (ret == 0) {
260		dev_dbg(hdq_data->dev, "break wait elapsed\n");
261		ret = -EINTR;
262		goto out;
263	}
264
265	/* check irqstatus */
266	if (!(tmp_status & OMAP_HDQ_INT_STATUS_TIMEOUT)) {
267		dev_dbg(hdq_data->dev, "timeout waiting for TIMEOUT, %x\n",
268			tmp_status);
269		ret = -ETIMEDOUT;
270		goto out;
271	}
272
273	/*
274	 * check for the presence detect bit to get
275	 * set to show that the slave is responding
276	 */
277	if (!(hdq_reg_in(hdq_data, OMAP_HDQ_CTRL_STATUS) &
278			OMAP_HDQ_CTRL_STATUS_PRESENCE)) {
279		dev_dbg(hdq_data->dev, "Presence bit not set\n");
280		ret = -ETIMEDOUT;
281		goto out;
282	}
283
284	/*
285	 * wait for both INIT and GO bits rerurn to zero.
286	 * zero wait time expected for interrupt mode.
287	 */
288	ret = hdq_wait_for_flag(hdq_data, OMAP_HDQ_CTRL_STATUS,
289			OMAP_HDQ_CTRL_STATUS_INITIALIZATION |
290			OMAP_HDQ_CTRL_STATUS_GO, OMAP_HDQ_FLAG_CLEAR,
291			&tmp_status);
292	if (ret)
293		dev_dbg(hdq_data->dev, "timeout waiting INIT&GO bits"
294			" return to zero, %x\n", tmp_status);
295
296out:
297	mutex_unlock(&hdq_data->hdq_mutex);
298rtn:
299	return ret;
300}
301
302static int hdq_read_byte(struct hdq_data *hdq_data, u8 *val)
303{
304	int ret = 0;
305	u8 status;
306
307	ret = mutex_lock_interruptible(&hdq_data->hdq_mutex);
308	if (ret < 0) {
309		ret = -EINTR;
310		goto rtn;
311	}
312
313	if (pm_runtime_suspended(hdq_data->dev)) {
314		ret = -EINVAL;
315		goto out;
316	}
317
318	if (!(hdq_data->hdq_irqstatus & OMAP_HDQ_INT_STATUS_RXCOMPLETE)) {
319		hdq_reg_merge(hdq_data, OMAP_HDQ_CTRL_STATUS,
320			OMAP_HDQ_CTRL_STATUS_DIR | OMAP_HDQ_CTRL_STATUS_GO,
321			OMAP_HDQ_CTRL_STATUS_DIR | OMAP_HDQ_CTRL_STATUS_GO);
322		/*
323		 * The RX comes immediately after TX.
324		 */
325		wait_event_timeout(hdq_wait_queue,
326				   (hdq_data->hdq_irqstatus
327				    & (OMAP_HDQ_INT_STATUS_RXCOMPLETE |
328				       OMAP_HDQ_INT_STATUS_TIMEOUT)),
329				   OMAP_HDQ_TIMEOUT);
330		status = hdq_reset_irqstatus(hdq_data,
331					     OMAP_HDQ_INT_STATUS_RXCOMPLETE |
332					     OMAP_HDQ_INT_STATUS_TIMEOUT);
333		hdq_reg_merge(hdq_data, OMAP_HDQ_CTRL_STATUS, 0,
334			OMAP_HDQ_CTRL_STATUS_DIR);
335
336		/* check irqstatus */
337		if (!(status & OMAP_HDQ_INT_STATUS_RXCOMPLETE)) {
338			dev_dbg(hdq_data->dev, "timeout waiting for"
339				" RXCOMPLETE, %x", status);
340			ret = -ETIMEDOUT;
341			goto out;
342		}
343	} else { /* interrupt had occurred before hdq_read_byte was called */
344		hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_RXCOMPLETE);
345	}
346	/* the data is ready. Read it in! */
347	*val = hdq_reg_in(hdq_data, OMAP_HDQ_RX_DATA);
348out:
349	mutex_unlock(&hdq_data->hdq_mutex);
350rtn:
351	return ret;
352
353}
354
355/*
356 * W1 triplet callback function - used for searching ROM addresses.
357 * Registered only when controller is in 1-wire mode.
358 */
359static u8 omap_w1_triplet(void *_hdq, u8 bdir)
360{
361	u8 id_bit, comp_bit;
362	int err;
363	u8 ret = 0x3; /* no slaves responded */
364	struct hdq_data *hdq_data = _hdq;
365	u8 ctrl = OMAP_HDQ_CTRL_STATUS_SINGLE | OMAP_HDQ_CTRL_STATUS_GO |
366		  OMAP_HDQ_CTRL_STATUS_INTERRUPTMASK;
367	u8 mask = ctrl | OMAP_HDQ_CTRL_STATUS_DIR;
368
369	err = pm_runtime_get_sync(hdq_data->dev);
370	if (err < 0) {
371		pm_runtime_put_noidle(hdq_data->dev);
372
373		return err;
374	}
375
376	err = mutex_lock_interruptible(&hdq_data->hdq_mutex);
377	if (err < 0) {
378		dev_dbg(hdq_data->dev, "Could not acquire mutex\n");
379		goto rtn;
380	}
381
382	/* read id_bit */
383	hdq_reg_merge(_hdq, OMAP_HDQ_CTRL_STATUS,
384		      ctrl | OMAP_HDQ_CTRL_STATUS_DIR, mask);
385	err = wait_event_timeout(hdq_wait_queue,
386				 (hdq_data->hdq_irqstatus
387				  & OMAP_HDQ_INT_STATUS_RXCOMPLETE),
388				 OMAP_HDQ_TIMEOUT);
389	/* Must clear irqstatus for another RXCOMPLETE interrupt */
390	hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_RXCOMPLETE);
391
392	if (err == 0) {
393		dev_dbg(hdq_data->dev, "RX wait elapsed\n");
394		goto out;
395	}
396	id_bit = (hdq_reg_in(_hdq, OMAP_HDQ_RX_DATA) & 0x01);
397
398	/* read comp_bit */
399	hdq_reg_merge(_hdq, OMAP_HDQ_CTRL_STATUS,
400		      ctrl | OMAP_HDQ_CTRL_STATUS_DIR, mask);
401	err = wait_event_timeout(hdq_wait_queue,
402				 (hdq_data->hdq_irqstatus
403				  & OMAP_HDQ_INT_STATUS_RXCOMPLETE),
404				 OMAP_HDQ_TIMEOUT);
405	/* Must clear irqstatus for another RXCOMPLETE interrupt */
406	hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_RXCOMPLETE);
407
408	if (err == 0) {
409		dev_dbg(hdq_data->dev, "RX wait elapsed\n");
410		goto out;
411	}
412	comp_bit = (hdq_reg_in(_hdq, OMAP_HDQ_RX_DATA) & 0x01);
413
414	if (id_bit && comp_bit) {
415		ret = 0x03;  /* no slaves responded */
416		goto out;
417	}
418	if (!id_bit && !comp_bit) {
419		/* Both bits are valid, take the direction given */
420		ret = bdir ? 0x04 : 0;
421	} else {
422		/* Only one bit is valid, take that direction */
423		bdir = id_bit;
424		ret = id_bit ? 0x05 : 0x02;
425	}
426
427	/* write bdir bit */
428	hdq_reg_out(_hdq, OMAP_HDQ_TX_DATA, bdir);
429	hdq_reg_merge(_hdq, OMAP_HDQ_CTRL_STATUS, ctrl, mask);
430	err = wait_event_timeout(hdq_wait_queue,
431				 (hdq_data->hdq_irqstatus
432				  & OMAP_HDQ_INT_STATUS_TXCOMPLETE),
433				 OMAP_HDQ_TIMEOUT);
434	/* Must clear irqstatus for another TXCOMPLETE interrupt */
435	hdq_reset_irqstatus(hdq_data, OMAP_HDQ_INT_STATUS_TXCOMPLETE);
436
437	if (err == 0) {
438		dev_dbg(hdq_data->dev, "TX wait elapsed\n");
439		goto out;
440	}
441
442	hdq_reg_merge(_hdq, OMAP_HDQ_CTRL_STATUS, 0,
443		      OMAP_HDQ_CTRL_STATUS_SINGLE);
444
445out:
446	mutex_unlock(&hdq_data->hdq_mutex);
447rtn:
448	pm_runtime_put_autosuspend(hdq_data->dev);
449
450	return ret;
451}
452
453/* reset callback */
454static u8 omap_w1_reset_bus(void *_hdq)
455{
456	struct hdq_data *hdq_data = _hdq;
457	int err;
458
459	err = pm_runtime_get_sync(hdq_data->dev);
460	if (err < 0) {
461		pm_runtime_put_noidle(hdq_data->dev);
462
463		return err;
464	}
465
466	omap_hdq_break(hdq_data);
467
468	pm_runtime_put_autosuspend(hdq_data->dev);
469
470	return 0;
471}
472
473/* Read a byte of data from the device */
474static u8 omap_w1_read_byte(void *_hdq)
475{
476	struct hdq_data *hdq_data = _hdq;
477	u8 val = 0;
478	int ret;
479
480	ret = pm_runtime_get_sync(hdq_data->dev);
481	if (ret < 0) {
482		pm_runtime_put_noidle(hdq_data->dev);
483
484		return -1;
485	}
486
487	ret = hdq_read_byte(hdq_data, &val);
488	if (ret)
489		val = -1;
490
491	pm_runtime_put_autosuspend(hdq_data->dev);
492
493	return val;
494}
495
496/* Write a byte of data to the device */
497static void omap_w1_write_byte(void *_hdq, u8 byte)
498{
499	struct hdq_data *hdq_data = _hdq;
500	int ret;
501	u8 status;
502
503	ret = pm_runtime_get_sync(hdq_data->dev);
504	if (ret < 0) {
505		pm_runtime_put_noidle(hdq_data->dev);
506
507		return;
508	}
509
510	/*
511	 * We need to reset the slave before
512	 * issuing the SKIP ROM command, else
513	 * the slave will not work.
514	 */
515	if (byte == W1_SKIP_ROM)
516		omap_hdq_break(hdq_data);
517
518	ret = hdq_write_byte(hdq_data, byte, &status);
519	if (ret < 0) {
520		dev_dbg(hdq_data->dev, "TX failure:Ctrl status %x\n", status);
521		goto out_err;
522	}
523
524out_err:
525	pm_runtime_put_autosuspend(hdq_data->dev);
526}
527
528static struct w1_bus_master omap_w1_master = {
529	.read_byte	= omap_w1_read_byte,
530	.write_byte	= omap_w1_write_byte,
531	.reset_bus	= omap_w1_reset_bus,
532};
533
534static int __maybe_unused omap_hdq_runtime_suspend(struct device *dev)
535{
536	struct hdq_data *hdq_data = dev_get_drvdata(dev);
537
538	hdq_reg_out(hdq_data, 0, hdq_data->mode);
539	hdq_reg_in(hdq_data, OMAP_HDQ_INT_STATUS);
540
541	return 0;
542}
543
544static int __maybe_unused omap_hdq_runtime_resume(struct device *dev)
545{
546	struct hdq_data *hdq_data = dev_get_drvdata(dev);
547
548	/* select HDQ/1W mode & enable clocks */
549	hdq_reg_out(hdq_data, OMAP_HDQ_CTRL_STATUS,
550		    OMAP_HDQ_CTRL_STATUS_CLOCKENABLE |
551		    OMAP_HDQ_CTRL_STATUS_INTERRUPTMASK |
552		    hdq_data->mode);
553	hdq_reg_in(hdq_data, OMAP_HDQ_INT_STATUS);
554
555	return 0;
556}
557
558static const struct dev_pm_ops omap_hdq_pm_ops = {
559	SET_RUNTIME_PM_OPS(omap_hdq_runtime_suspend,
560			   omap_hdq_runtime_resume, NULL)
561};
562
563static int omap_hdq_probe(struct platform_device *pdev)
564{
565	struct device *dev = &pdev->dev;
566	struct hdq_data *hdq_data;
567	int ret, irq;
568	u8 rev;
569	const char *mode;
570
571	hdq_data = devm_kzalloc(dev, sizeof(*hdq_data), GFP_KERNEL);
572	if (!hdq_data)
573		return -ENOMEM;
574
575	hdq_data->dev = dev;
576	platform_set_drvdata(pdev, hdq_data);
577
578	hdq_data->hdq_base = devm_platform_ioremap_resource(pdev, 0);
579	if (IS_ERR(hdq_data->hdq_base))
580		return PTR_ERR(hdq_data->hdq_base);
581
582	mutex_init(&hdq_data->hdq_mutex);
583
584	ret = of_property_read_string(pdev->dev.of_node, "ti,mode", &mode);
585	if (ret < 0 || !strcmp(mode, "hdq")) {
586		hdq_data->mode = 0;
587		omap_w1_master.search = omap_w1_search_bus;
588	} else {
589		hdq_data->mode = 1;
590		omap_w1_master.triplet = omap_w1_triplet;
591	}
592
593	pm_runtime_enable(&pdev->dev);
594	pm_runtime_use_autosuspend(&pdev->dev);
595	pm_runtime_set_autosuspend_delay(&pdev->dev, 300);
596	ret = pm_runtime_get_sync(&pdev->dev);
597	if (ret < 0) {
598		pm_runtime_put_noidle(&pdev->dev);
599		dev_dbg(&pdev->dev, "pm_runtime_get_sync failed\n");
600		goto err_w1;
601	}
602
603	rev = hdq_reg_in(hdq_data, OMAP_HDQ_REVISION);
604	dev_info(&pdev->dev, "OMAP HDQ Hardware Rev %c.%c. Driver in %s mode\n",
605		(rev >> 4) + '0', (rev & 0x0f) + '0', "Interrupt");
606
607	spin_lock_init(&hdq_data->hdq_spinlock);
608
609	irq = platform_get_irq(pdev, 0);
610	if (irq	< 0) {
611		dev_dbg(&pdev->dev, "Failed to get IRQ: %d\n", irq);
612		ret = irq;
613		goto err_irq;
614	}
615
616	ret = devm_request_irq(dev, irq, hdq_isr, 0, "omap_hdq", hdq_data);
617	if (ret < 0) {
618		dev_dbg(&pdev->dev, "could not request irq\n");
619		goto err_irq;
620	}
621
622	omap_hdq_break(hdq_data);
623
624	pm_runtime_put_autosuspend(&pdev->dev);
625
626	omap_w1_master.data = hdq_data;
627
628	ret = w1_add_master_device(&omap_w1_master);
629	if (ret) {
630		dev_dbg(&pdev->dev, "Failure in registering w1 master\n");
631		goto err_w1;
632	}
633
634	return 0;
635
636err_irq:
637	pm_runtime_put_sync(&pdev->dev);
638err_w1:
639	pm_runtime_dont_use_autosuspend(&pdev->dev);
640	pm_runtime_disable(&pdev->dev);
641
642	return ret;
643}
644
645static void omap_hdq_remove(struct platform_device *pdev)
646{
647	int active;
648
649	active = pm_runtime_get_sync(&pdev->dev);
650	if (active < 0)
651		pm_runtime_put_noidle(&pdev->dev);
652
653	w1_remove_master_device(&omap_w1_master);
654
655	pm_runtime_dont_use_autosuspend(&pdev->dev);
656	if (active >= 0)
657		pm_runtime_put_sync(&pdev->dev);
658	pm_runtime_disable(&pdev->dev);
659}
660
661static const struct of_device_id omap_hdq_dt_ids[] = {
662	{ .compatible = "ti,omap3-1w" },
663	{ .compatible = "ti,am4372-hdq" },
664	{}
665};
666MODULE_DEVICE_TABLE(of, omap_hdq_dt_ids);
667
668static struct platform_driver omap_hdq_driver = {
669	.probe = omap_hdq_probe,
670	.remove = omap_hdq_remove,
671	.driver = {
672		.name =	"omap_hdq",
673		.of_match_table = omap_hdq_dt_ids,
674		.pm = &omap_hdq_pm_ops,
675	},
676};
677module_platform_driver(omap_hdq_driver);
678
679MODULE_AUTHOR("Texas Instruments");
680MODULE_DESCRIPTION("HDQ-1W driver Library");
681MODULE_LICENSE("GPL");
~/ Read-only file preview.