Linux Audio

Check our new training course

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