xref: /OK3568_Linux_fs/kernel/drivers/siox/siox-core.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) 2015-2017 Pengutronix, Uwe Kleine-König <kernel@pengutronix.de>
4*4882a593Smuzhiyun  */
5*4882a593Smuzhiyun #include <linux/kernel.h>
6*4882a593Smuzhiyun #include <linux/device.h>
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/sysfs.h>
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #include "siox.h"
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun /*
14*4882a593Smuzhiyun  * The lowest bit in the SIOX status word signals if the in-device watchdog is
15*4882a593Smuzhiyun  * ok. If the bit is set, the device is functional.
16*4882a593Smuzhiyun  *
17*4882a593Smuzhiyun  * On writing the watchdog timer is reset when this bit toggles.
18*4882a593Smuzhiyun  */
19*4882a593Smuzhiyun #define SIOX_STATUS_WDG			0x01
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun /*
22*4882a593Smuzhiyun  * Bits 1 to 3 of the status word read as the bitwise negation of what was
23*4882a593Smuzhiyun  * clocked in before. The value clocked in is changed in each cycle and so
24*4882a593Smuzhiyun  * allows to detect transmit/receive problems.
25*4882a593Smuzhiyun  */
26*4882a593Smuzhiyun #define SIOX_STATUS_COUNTER		0x0e
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun /*
29*4882a593Smuzhiyun  * Each Siox-Device has a 4 bit type number that is neither 0 nor 15. This is
30*4882a593Smuzhiyun  * available in the upper nibble of the read status.
31*4882a593Smuzhiyun  *
32*4882a593Smuzhiyun  * On write these bits are DC.
33*4882a593Smuzhiyun  */
34*4882a593Smuzhiyun #define SIOX_STATUS_TYPE		0xf0
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define CREATE_TRACE_POINTS
37*4882a593Smuzhiyun #include <trace/events/siox.h>
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun static bool siox_is_registered;
40*4882a593Smuzhiyun 
siox_master_lock(struct siox_master * smaster)41*4882a593Smuzhiyun static void siox_master_lock(struct siox_master *smaster)
42*4882a593Smuzhiyun {
43*4882a593Smuzhiyun 	mutex_lock(&smaster->lock);
44*4882a593Smuzhiyun }
45*4882a593Smuzhiyun 
siox_master_unlock(struct siox_master * smaster)46*4882a593Smuzhiyun static void siox_master_unlock(struct siox_master *smaster)
47*4882a593Smuzhiyun {
48*4882a593Smuzhiyun 	mutex_unlock(&smaster->lock);
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun 
siox_status_clean(u8 status_read,u8 status_written)51*4882a593Smuzhiyun static inline u8 siox_status_clean(u8 status_read, u8 status_written)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun 	/*
54*4882a593Smuzhiyun 	 * bits 3:1 of status sample the respective bit in the status
55*4882a593Smuzhiyun 	 * byte written in the previous cycle but inverted. So if you wrote the
56*4882a593Smuzhiyun 	 * status word as 0xa before (counter = 0b101), it is expected to get
57*4882a593Smuzhiyun 	 * back the counter bits as 0b010.
58*4882a593Smuzhiyun 	 *
59*4882a593Smuzhiyun 	 * So given the last status written this function toggles the there
60*4882a593Smuzhiyun 	 * unset counter bits in the read value such that the counter bits in
61*4882a593Smuzhiyun 	 * the return value are all zero iff the bits were read as expected to
62*4882a593Smuzhiyun 	 * simplify error detection.
63*4882a593Smuzhiyun 	 */
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 	return status_read ^ (~status_written & 0xe);
66*4882a593Smuzhiyun }
67*4882a593Smuzhiyun 
siox_device_counter_error(struct siox_device * sdevice,u8 status_clean)68*4882a593Smuzhiyun static bool siox_device_counter_error(struct siox_device *sdevice,
69*4882a593Smuzhiyun 				      u8 status_clean)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun 	return (status_clean & SIOX_STATUS_COUNTER) != 0;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun 
siox_device_type_error(struct siox_device * sdevice,u8 status_clean)74*4882a593Smuzhiyun static bool siox_device_type_error(struct siox_device *sdevice, u8 status_clean)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	u8 statustype = (status_clean & SIOX_STATUS_TYPE) >> 4;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	/*
79*4882a593Smuzhiyun 	 * If the device knows which value the type bits should have, check
80*4882a593Smuzhiyun 	 * against this value otherwise just rule out the invalid values 0b0000
81*4882a593Smuzhiyun 	 * and 0b1111.
82*4882a593Smuzhiyun 	 */
83*4882a593Smuzhiyun 	if (sdevice->statustype) {
84*4882a593Smuzhiyun 		if (statustype != sdevice->statustype)
85*4882a593Smuzhiyun 			return true;
86*4882a593Smuzhiyun 	} else {
87*4882a593Smuzhiyun 		switch (statustype) {
88*4882a593Smuzhiyun 		case 0:
89*4882a593Smuzhiyun 		case 0xf:
90*4882a593Smuzhiyun 			return true;
91*4882a593Smuzhiyun 		}
92*4882a593Smuzhiyun 	}
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	return false;
95*4882a593Smuzhiyun }
96*4882a593Smuzhiyun 
siox_device_wdg_error(struct siox_device * sdevice,u8 status_clean)97*4882a593Smuzhiyun static bool siox_device_wdg_error(struct siox_device *sdevice, u8 status_clean)
98*4882a593Smuzhiyun {
99*4882a593Smuzhiyun 	return (status_clean & SIOX_STATUS_WDG) == 0;
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun /*
103*4882a593Smuzhiyun  * If there is a type or counter error the device is called "unsynced".
104*4882a593Smuzhiyun  */
siox_device_synced(struct siox_device * sdevice)105*4882a593Smuzhiyun bool siox_device_synced(struct siox_device *sdevice)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	if (siox_device_type_error(sdevice, sdevice->status_read_clean))
108*4882a593Smuzhiyun 		return false;
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	return !siox_device_counter_error(sdevice, sdevice->status_read_clean);
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun }
113*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(siox_device_synced);
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun /*
116*4882a593Smuzhiyun  * A device is called "connected" if it is synced and the watchdog is not
117*4882a593Smuzhiyun  * asserted.
118*4882a593Smuzhiyun  */
siox_device_connected(struct siox_device * sdevice)119*4882a593Smuzhiyun bool siox_device_connected(struct siox_device *sdevice)
120*4882a593Smuzhiyun {
121*4882a593Smuzhiyun 	if (!siox_device_synced(sdevice))
122*4882a593Smuzhiyun 		return false;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 	return !siox_device_wdg_error(sdevice, sdevice->status_read_clean);
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(siox_device_connected);
127*4882a593Smuzhiyun 
siox_poll(struct siox_master * smaster)128*4882a593Smuzhiyun static void siox_poll(struct siox_master *smaster)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun 	struct siox_device *sdevice;
131*4882a593Smuzhiyun 	size_t i = smaster->setbuf_len;
132*4882a593Smuzhiyun 	unsigned int devno = 0;
133*4882a593Smuzhiyun 	int unsync_error = 0;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	smaster->last_poll = jiffies;
136*4882a593Smuzhiyun 
137*4882a593Smuzhiyun 	/*
138*4882a593Smuzhiyun 	 * The counter bits change in each second cycle, the watchdog bit
139*4882a593Smuzhiyun 	 * toggles each time.
140*4882a593Smuzhiyun 	 * The counter bits hold values from [0, 6]. 7 would be possible
141*4882a593Smuzhiyun 	 * theoretically but the protocol designer considered that a bad idea
142*4882a593Smuzhiyun 	 * for reasons unknown today. (Maybe that's because then the status read
143*4882a593Smuzhiyun 	 * back has only zeros in the counter bits then which might be confused
144*4882a593Smuzhiyun 	 * with a stuck-at-0 error. But for the same reason (with s/0/1/) 0
145*4882a593Smuzhiyun 	 * could be skipped.)
146*4882a593Smuzhiyun 	 */
147*4882a593Smuzhiyun 	if (++smaster->status > 0x0d)
148*4882a593Smuzhiyun 		smaster->status = 0;
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun 	memset(smaster->buf, 0, smaster->setbuf_len);
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun 	/* prepare data pushed out to devices in buf[0..setbuf_len) */
153*4882a593Smuzhiyun 	list_for_each_entry(sdevice, &smaster->devices, node) {
154*4882a593Smuzhiyun 		struct siox_driver *sdriver =
155*4882a593Smuzhiyun 			to_siox_driver(sdevice->dev.driver);
156*4882a593Smuzhiyun 		sdevice->status_written = smaster->status;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 		i -= sdevice->inbytes;
159*4882a593Smuzhiyun 
160*4882a593Smuzhiyun 		/*
161*4882a593Smuzhiyun 		 * If the device or a previous one is unsynced, don't pet the
162*4882a593Smuzhiyun 		 * watchdog. This is done to ensure that the device is kept in
163*4882a593Smuzhiyun 		 * reset when something is wrong.
164*4882a593Smuzhiyun 		 */
165*4882a593Smuzhiyun 		if (!siox_device_synced(sdevice))
166*4882a593Smuzhiyun 			unsync_error = 1;
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 		if (sdriver && !unsync_error)
169*4882a593Smuzhiyun 			sdriver->set_data(sdevice, sdevice->status_written,
170*4882a593Smuzhiyun 					  &smaster->buf[i + 1]);
171*4882a593Smuzhiyun 		else
172*4882a593Smuzhiyun 			/*
173*4882a593Smuzhiyun 			 * Don't trigger watchdog if there is no driver or a
174*4882a593Smuzhiyun 			 * sync problem
175*4882a593Smuzhiyun 			 */
176*4882a593Smuzhiyun 			sdevice->status_written &= ~SIOX_STATUS_WDG;
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun 		smaster->buf[i] = sdevice->status_written;
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 		trace_siox_set_data(smaster, sdevice, devno, i);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 		devno++;
183*4882a593Smuzhiyun 	}
184*4882a593Smuzhiyun 
185*4882a593Smuzhiyun 	smaster->pushpull(smaster, smaster->setbuf_len, smaster->buf,
186*4882a593Smuzhiyun 			  smaster->getbuf_len,
187*4882a593Smuzhiyun 			  smaster->buf + smaster->setbuf_len);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	unsync_error = 0;
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun 	/* interpret data pulled in from devices in buf[setbuf_len..] */
192*4882a593Smuzhiyun 	devno = 0;
193*4882a593Smuzhiyun 	i = smaster->setbuf_len;
194*4882a593Smuzhiyun 	list_for_each_entry(sdevice, &smaster->devices, node) {
195*4882a593Smuzhiyun 		struct siox_driver *sdriver =
196*4882a593Smuzhiyun 			to_siox_driver(sdevice->dev.driver);
197*4882a593Smuzhiyun 		u8 status = smaster->buf[i + sdevice->outbytes - 1];
198*4882a593Smuzhiyun 		u8 status_clean;
199*4882a593Smuzhiyun 		u8 prev_status_clean = sdevice->status_read_clean;
200*4882a593Smuzhiyun 		bool synced = true;
201*4882a593Smuzhiyun 		bool connected = true;
202*4882a593Smuzhiyun 
203*4882a593Smuzhiyun 		if (!siox_device_synced(sdevice))
204*4882a593Smuzhiyun 			unsync_error = 1;
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 		/*
207*4882a593Smuzhiyun 		 * If the watchdog bit wasn't toggled in this cycle, report the
208*4882a593Smuzhiyun 		 * watchdog as active to give a consistent view for drivers and
209*4882a593Smuzhiyun 		 * sysfs consumers.
210*4882a593Smuzhiyun 		 */
211*4882a593Smuzhiyun 		if (!sdriver || unsync_error)
212*4882a593Smuzhiyun 			status &= ~SIOX_STATUS_WDG;
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 		status_clean =
215*4882a593Smuzhiyun 			siox_status_clean(status,
216*4882a593Smuzhiyun 					  sdevice->status_written_lastcycle);
217*4882a593Smuzhiyun 
218*4882a593Smuzhiyun 		/* Check counter and type bits */
219*4882a593Smuzhiyun 		if (siox_device_counter_error(sdevice, status_clean) ||
220*4882a593Smuzhiyun 		    siox_device_type_error(sdevice, status_clean)) {
221*4882a593Smuzhiyun 			bool prev_error;
222*4882a593Smuzhiyun 
223*4882a593Smuzhiyun 			synced = false;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 			/* only report a new error if the last cycle was ok */
226*4882a593Smuzhiyun 			prev_error =
227*4882a593Smuzhiyun 				siox_device_counter_error(sdevice,
228*4882a593Smuzhiyun 							  prev_status_clean) ||
229*4882a593Smuzhiyun 				siox_device_type_error(sdevice,
230*4882a593Smuzhiyun 						       prev_status_clean);
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 			if (!prev_error) {
233*4882a593Smuzhiyun 				sdevice->status_errors++;
234*4882a593Smuzhiyun 				sysfs_notify_dirent(sdevice->status_errors_kn);
235*4882a593Smuzhiyun 			}
236*4882a593Smuzhiyun 		}
237*4882a593Smuzhiyun 
238*4882a593Smuzhiyun 		/* If the device is unsynced report the watchdog as active */
239*4882a593Smuzhiyun 		if (!synced) {
240*4882a593Smuzhiyun 			status &= ~SIOX_STATUS_WDG;
241*4882a593Smuzhiyun 			status_clean &= ~SIOX_STATUS_WDG;
242*4882a593Smuzhiyun 		}
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 		if (siox_device_wdg_error(sdevice, status_clean))
245*4882a593Smuzhiyun 			connected = false;
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 		/* The watchdog state changed just now */
248*4882a593Smuzhiyun 		if ((status_clean ^ prev_status_clean) & SIOX_STATUS_WDG) {
249*4882a593Smuzhiyun 			sysfs_notify_dirent(sdevice->watchdog_kn);
250*4882a593Smuzhiyun 
251*4882a593Smuzhiyun 			if (siox_device_wdg_error(sdevice, status_clean)) {
252*4882a593Smuzhiyun 				struct kernfs_node *wd_errs =
253*4882a593Smuzhiyun 					sdevice->watchdog_errors_kn;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 				sdevice->watchdog_errors++;
256*4882a593Smuzhiyun 				sysfs_notify_dirent(wd_errs);
257*4882a593Smuzhiyun 			}
258*4882a593Smuzhiyun 		}
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 		if (connected != sdevice->connected)
261*4882a593Smuzhiyun 			sysfs_notify_dirent(sdevice->connected_kn);
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun 		sdevice->status_read_clean = status_clean;
264*4882a593Smuzhiyun 		sdevice->status_written_lastcycle = sdevice->status_written;
265*4882a593Smuzhiyun 		sdevice->connected = connected;
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 		trace_siox_get_data(smaster, sdevice, devno, status_clean, i);
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 		/* only give data read to driver if the device is connected */
270*4882a593Smuzhiyun 		if (sdriver && connected)
271*4882a593Smuzhiyun 			sdriver->get_data(sdevice, &smaster->buf[i]);
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 		devno++;
274*4882a593Smuzhiyun 		i += sdevice->outbytes;
275*4882a593Smuzhiyun 	}
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun 
siox_poll_thread(void * data)278*4882a593Smuzhiyun static int siox_poll_thread(void *data)
279*4882a593Smuzhiyun {
280*4882a593Smuzhiyun 	struct siox_master *smaster = data;
281*4882a593Smuzhiyun 	signed long timeout = 0;
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 	get_device(&smaster->dev);
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun 	for (;;) {
286*4882a593Smuzhiyun 		if (kthread_should_stop()) {
287*4882a593Smuzhiyun 			put_device(&smaster->dev);
288*4882a593Smuzhiyun 			return 0;
289*4882a593Smuzhiyun 		}
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 		siox_master_lock(smaster);
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 		if (smaster->active) {
294*4882a593Smuzhiyun 			unsigned long next_poll =
295*4882a593Smuzhiyun 				smaster->last_poll + smaster->poll_interval;
296*4882a593Smuzhiyun 			if (time_is_before_eq_jiffies(next_poll))
297*4882a593Smuzhiyun 				siox_poll(smaster);
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun 			timeout = smaster->poll_interval -
300*4882a593Smuzhiyun 				(jiffies - smaster->last_poll);
301*4882a593Smuzhiyun 		} else {
302*4882a593Smuzhiyun 			timeout = MAX_SCHEDULE_TIMEOUT;
303*4882a593Smuzhiyun 		}
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 		/*
306*4882a593Smuzhiyun 		 * Set the task to idle while holding the lock. This makes sure
307*4882a593Smuzhiyun 		 * that we don't sleep too long when the bus is reenabled before
308*4882a593Smuzhiyun 		 * schedule_timeout is reached.
309*4882a593Smuzhiyun 		 */
310*4882a593Smuzhiyun 		if (timeout > 0)
311*4882a593Smuzhiyun 			set_current_state(TASK_IDLE);
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 		siox_master_unlock(smaster);
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 		if (timeout > 0)
316*4882a593Smuzhiyun 			schedule_timeout(timeout);
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 		/*
319*4882a593Smuzhiyun 		 * I'm not clear if/why it is important to set the state to
320*4882a593Smuzhiyun 		 * RUNNING again, but it fixes a "do not call blocking ops when
321*4882a593Smuzhiyun 		 * !TASK_RUNNING;"-warning.
322*4882a593Smuzhiyun 		 */
323*4882a593Smuzhiyun 		set_current_state(TASK_RUNNING);
324*4882a593Smuzhiyun 	}
325*4882a593Smuzhiyun }
326*4882a593Smuzhiyun 
__siox_start(struct siox_master * smaster)327*4882a593Smuzhiyun static int __siox_start(struct siox_master *smaster)
328*4882a593Smuzhiyun {
329*4882a593Smuzhiyun 	if (!(smaster->setbuf_len + smaster->getbuf_len))
330*4882a593Smuzhiyun 		return -ENODEV;
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	if (!smaster->buf)
333*4882a593Smuzhiyun 		return -ENOMEM;
334*4882a593Smuzhiyun 
335*4882a593Smuzhiyun 	if (smaster->active)
336*4882a593Smuzhiyun 		return 0;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	smaster->active = 1;
339*4882a593Smuzhiyun 	wake_up_process(smaster->poll_thread);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	return 1;
342*4882a593Smuzhiyun }
343*4882a593Smuzhiyun 
siox_start(struct siox_master * smaster)344*4882a593Smuzhiyun static int siox_start(struct siox_master *smaster)
345*4882a593Smuzhiyun {
346*4882a593Smuzhiyun 	int ret;
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	siox_master_lock(smaster);
349*4882a593Smuzhiyun 	ret = __siox_start(smaster);
350*4882a593Smuzhiyun 	siox_master_unlock(smaster);
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	return ret;
353*4882a593Smuzhiyun }
354*4882a593Smuzhiyun 
__siox_stop(struct siox_master * smaster)355*4882a593Smuzhiyun static int __siox_stop(struct siox_master *smaster)
356*4882a593Smuzhiyun {
357*4882a593Smuzhiyun 	if (smaster->active) {
358*4882a593Smuzhiyun 		struct siox_device *sdevice;
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun 		smaster->active = 0;
361*4882a593Smuzhiyun 
362*4882a593Smuzhiyun 		list_for_each_entry(sdevice, &smaster->devices, node) {
363*4882a593Smuzhiyun 			if (sdevice->connected)
364*4882a593Smuzhiyun 				sysfs_notify_dirent(sdevice->connected_kn);
365*4882a593Smuzhiyun 			sdevice->connected = false;
366*4882a593Smuzhiyun 		}
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun 		return 1;
369*4882a593Smuzhiyun 	}
370*4882a593Smuzhiyun 	return 0;
371*4882a593Smuzhiyun }
372*4882a593Smuzhiyun 
siox_stop(struct siox_master * smaster)373*4882a593Smuzhiyun static int siox_stop(struct siox_master *smaster)
374*4882a593Smuzhiyun {
375*4882a593Smuzhiyun 	int ret;
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	siox_master_lock(smaster);
378*4882a593Smuzhiyun 	ret = __siox_stop(smaster);
379*4882a593Smuzhiyun 	siox_master_unlock(smaster);
380*4882a593Smuzhiyun 
381*4882a593Smuzhiyun 	return ret;
382*4882a593Smuzhiyun }
383*4882a593Smuzhiyun 
type_show(struct device * dev,struct device_attribute * attr,char * buf)384*4882a593Smuzhiyun static ssize_t type_show(struct device *dev,
385*4882a593Smuzhiyun 			 struct device_attribute *attr, char *buf)
386*4882a593Smuzhiyun {
387*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	return sprintf(buf, "%s\n", sdev->type);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun 
392*4882a593Smuzhiyun static DEVICE_ATTR_RO(type);
393*4882a593Smuzhiyun 
inbytes_show(struct device * dev,struct device_attribute * attr,char * buf)394*4882a593Smuzhiyun static ssize_t inbytes_show(struct device *dev,
395*4882a593Smuzhiyun 			    struct device_attribute *attr, char *buf)
396*4882a593Smuzhiyun {
397*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	return sprintf(buf, "%zu\n", sdev->inbytes);
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun 
402*4882a593Smuzhiyun static DEVICE_ATTR_RO(inbytes);
403*4882a593Smuzhiyun 
outbytes_show(struct device * dev,struct device_attribute * attr,char * buf)404*4882a593Smuzhiyun static ssize_t outbytes_show(struct device *dev,
405*4882a593Smuzhiyun 			     struct device_attribute *attr, char *buf)
406*4882a593Smuzhiyun {
407*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	return sprintf(buf, "%zu\n", sdev->outbytes);
410*4882a593Smuzhiyun }
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun static DEVICE_ATTR_RO(outbytes);
413*4882a593Smuzhiyun 
status_errors_show(struct device * dev,struct device_attribute * attr,char * buf)414*4882a593Smuzhiyun static ssize_t status_errors_show(struct device *dev,
415*4882a593Smuzhiyun 				  struct device_attribute *attr, char *buf)
416*4882a593Smuzhiyun {
417*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
418*4882a593Smuzhiyun 	unsigned int status_errors;
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	siox_master_lock(sdev->smaster);
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 	status_errors = sdev->status_errors;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	siox_master_unlock(sdev->smaster);
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	return sprintf(buf, "%u\n", status_errors);
427*4882a593Smuzhiyun }
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun static DEVICE_ATTR_RO(status_errors);
430*4882a593Smuzhiyun 
connected_show(struct device * dev,struct device_attribute * attr,char * buf)431*4882a593Smuzhiyun static ssize_t connected_show(struct device *dev,
432*4882a593Smuzhiyun 			      struct device_attribute *attr, char *buf)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
435*4882a593Smuzhiyun 	bool connected;
436*4882a593Smuzhiyun 
437*4882a593Smuzhiyun 	siox_master_lock(sdev->smaster);
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	connected = sdev->connected;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	siox_master_unlock(sdev->smaster);
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	return sprintf(buf, "%u\n", connected);
444*4882a593Smuzhiyun }
445*4882a593Smuzhiyun 
446*4882a593Smuzhiyun static DEVICE_ATTR_RO(connected);
447*4882a593Smuzhiyun 
watchdog_show(struct device * dev,struct device_attribute * attr,char * buf)448*4882a593Smuzhiyun static ssize_t watchdog_show(struct device *dev,
449*4882a593Smuzhiyun 			     struct device_attribute *attr, char *buf)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
452*4882a593Smuzhiyun 	u8 status;
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 	siox_master_lock(sdev->smaster);
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	status = sdev->status_read_clean;
457*4882a593Smuzhiyun 
458*4882a593Smuzhiyun 	siox_master_unlock(sdev->smaster);
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	return sprintf(buf, "%d\n", status & SIOX_STATUS_WDG);
461*4882a593Smuzhiyun }
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun static DEVICE_ATTR_RO(watchdog);
464*4882a593Smuzhiyun 
watchdog_errors_show(struct device * dev,struct device_attribute * attr,char * buf)465*4882a593Smuzhiyun static ssize_t watchdog_errors_show(struct device *dev,
466*4882a593Smuzhiyun 				    struct device_attribute *attr, char *buf)
467*4882a593Smuzhiyun {
468*4882a593Smuzhiyun 	struct siox_device *sdev = to_siox_device(dev);
469*4882a593Smuzhiyun 	unsigned int watchdog_errors;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	siox_master_lock(sdev->smaster);
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	watchdog_errors = sdev->watchdog_errors;
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 	siox_master_unlock(sdev->smaster);
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	return sprintf(buf, "%u\n", watchdog_errors);
478*4882a593Smuzhiyun }
479*4882a593Smuzhiyun 
480*4882a593Smuzhiyun static DEVICE_ATTR_RO(watchdog_errors);
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun static struct attribute *siox_device_attrs[] = {
483*4882a593Smuzhiyun 	&dev_attr_type.attr,
484*4882a593Smuzhiyun 	&dev_attr_inbytes.attr,
485*4882a593Smuzhiyun 	&dev_attr_outbytes.attr,
486*4882a593Smuzhiyun 	&dev_attr_status_errors.attr,
487*4882a593Smuzhiyun 	&dev_attr_connected.attr,
488*4882a593Smuzhiyun 	&dev_attr_watchdog.attr,
489*4882a593Smuzhiyun 	&dev_attr_watchdog_errors.attr,
490*4882a593Smuzhiyun 	NULL
491*4882a593Smuzhiyun };
492*4882a593Smuzhiyun ATTRIBUTE_GROUPS(siox_device);
493*4882a593Smuzhiyun 
siox_device_release(struct device * dev)494*4882a593Smuzhiyun static void siox_device_release(struct device *dev)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun 	struct siox_device *sdevice = to_siox_device(dev);
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	kfree(sdevice);
499*4882a593Smuzhiyun }
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun static struct device_type siox_device_type = {
502*4882a593Smuzhiyun 	.groups = siox_device_groups,
503*4882a593Smuzhiyun 	.release = siox_device_release,
504*4882a593Smuzhiyun };
505*4882a593Smuzhiyun 
siox_match(struct device * dev,struct device_driver * drv)506*4882a593Smuzhiyun static int siox_match(struct device *dev, struct device_driver *drv)
507*4882a593Smuzhiyun {
508*4882a593Smuzhiyun 	if (dev->type != &siox_device_type)
509*4882a593Smuzhiyun 		return 0;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	/* up to now there is only a single driver so keeping this simple */
512*4882a593Smuzhiyun 	return 1;
513*4882a593Smuzhiyun }
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun static struct bus_type siox_bus_type = {
516*4882a593Smuzhiyun 	.name = "siox",
517*4882a593Smuzhiyun 	.match = siox_match,
518*4882a593Smuzhiyun };
519*4882a593Smuzhiyun 
siox_driver_probe(struct device * dev)520*4882a593Smuzhiyun static int siox_driver_probe(struct device *dev)
521*4882a593Smuzhiyun {
522*4882a593Smuzhiyun 	struct siox_driver *sdriver = to_siox_driver(dev->driver);
523*4882a593Smuzhiyun 	struct siox_device *sdevice = to_siox_device(dev);
524*4882a593Smuzhiyun 	int ret;
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	ret = sdriver->probe(sdevice);
527*4882a593Smuzhiyun 	return ret;
528*4882a593Smuzhiyun }
529*4882a593Smuzhiyun 
siox_driver_remove(struct device * dev)530*4882a593Smuzhiyun static int siox_driver_remove(struct device *dev)
531*4882a593Smuzhiyun {
532*4882a593Smuzhiyun 	struct siox_driver *sdriver =
533*4882a593Smuzhiyun 		container_of(dev->driver, struct siox_driver, driver);
534*4882a593Smuzhiyun 	struct siox_device *sdevice = to_siox_device(dev);
535*4882a593Smuzhiyun 	int ret;
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	ret = sdriver->remove(sdevice);
538*4882a593Smuzhiyun 	return ret;
539*4882a593Smuzhiyun }
540*4882a593Smuzhiyun 
siox_driver_shutdown(struct device * dev)541*4882a593Smuzhiyun static void siox_driver_shutdown(struct device *dev)
542*4882a593Smuzhiyun {
543*4882a593Smuzhiyun 	struct siox_driver *sdriver =
544*4882a593Smuzhiyun 		container_of(dev->driver, struct siox_driver, driver);
545*4882a593Smuzhiyun 	struct siox_device *sdevice = to_siox_device(dev);
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	sdriver->shutdown(sdevice);
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun 
active_show(struct device * dev,struct device_attribute * attr,char * buf)550*4882a593Smuzhiyun static ssize_t active_show(struct device *dev,
551*4882a593Smuzhiyun 			   struct device_attribute *attr, char *buf)
552*4882a593Smuzhiyun {
553*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
554*4882a593Smuzhiyun 
555*4882a593Smuzhiyun 	return sprintf(buf, "%d\n", smaster->active);
556*4882a593Smuzhiyun }
557*4882a593Smuzhiyun 
active_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)558*4882a593Smuzhiyun static ssize_t active_store(struct device *dev,
559*4882a593Smuzhiyun 			    struct device_attribute *attr,
560*4882a593Smuzhiyun 			    const char *buf, size_t count)
561*4882a593Smuzhiyun {
562*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
563*4882a593Smuzhiyun 	int ret;
564*4882a593Smuzhiyun 	int active;
565*4882a593Smuzhiyun 
566*4882a593Smuzhiyun 	ret = kstrtoint(buf, 0, &active);
567*4882a593Smuzhiyun 	if (ret < 0)
568*4882a593Smuzhiyun 		return ret;
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	if (active)
571*4882a593Smuzhiyun 		ret = siox_start(smaster);
572*4882a593Smuzhiyun 	else
573*4882a593Smuzhiyun 		ret = siox_stop(smaster);
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	if (ret < 0)
576*4882a593Smuzhiyun 		return ret;
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	return count;
579*4882a593Smuzhiyun }
580*4882a593Smuzhiyun 
581*4882a593Smuzhiyun static DEVICE_ATTR_RW(active);
582*4882a593Smuzhiyun 
583*4882a593Smuzhiyun static struct siox_device *siox_device_add(struct siox_master *smaster,
584*4882a593Smuzhiyun 					   const char *type, size_t inbytes,
585*4882a593Smuzhiyun 					   size_t outbytes, u8 statustype);
586*4882a593Smuzhiyun 
device_add_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)587*4882a593Smuzhiyun static ssize_t device_add_store(struct device *dev,
588*4882a593Smuzhiyun 				struct device_attribute *attr,
589*4882a593Smuzhiyun 				const char *buf, size_t count)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
592*4882a593Smuzhiyun 	int ret;
593*4882a593Smuzhiyun 	char type[20] = "";
594*4882a593Smuzhiyun 	size_t inbytes = 0, outbytes = 0;
595*4882a593Smuzhiyun 	u8 statustype = 0;
596*4882a593Smuzhiyun 
597*4882a593Smuzhiyun 	ret = sscanf(buf, "%19s %zu %zu %hhu", type, &inbytes,
598*4882a593Smuzhiyun 		     &outbytes, &statustype);
599*4882a593Smuzhiyun 	if (ret != 3 && ret != 4)
600*4882a593Smuzhiyun 		return -EINVAL;
601*4882a593Smuzhiyun 
602*4882a593Smuzhiyun 	if (strcmp(type, "siox-12x8") || inbytes != 2 || outbytes != 4)
603*4882a593Smuzhiyun 		return -EINVAL;
604*4882a593Smuzhiyun 
605*4882a593Smuzhiyun 	siox_device_add(smaster, "siox-12x8", inbytes, outbytes, statustype);
606*4882a593Smuzhiyun 
607*4882a593Smuzhiyun 	return count;
608*4882a593Smuzhiyun }
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun static DEVICE_ATTR_WO(device_add);
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun static void siox_device_remove(struct siox_master *smaster);
613*4882a593Smuzhiyun 
device_remove_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)614*4882a593Smuzhiyun static ssize_t device_remove_store(struct device *dev,
615*4882a593Smuzhiyun 				   struct device_attribute *attr,
616*4882a593Smuzhiyun 				   const char *buf, size_t count)
617*4882a593Smuzhiyun {
618*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
619*4882a593Smuzhiyun 
620*4882a593Smuzhiyun 	/* XXX? require to write <type> <inbytes> <outbytes> */
621*4882a593Smuzhiyun 	siox_device_remove(smaster);
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	return count;
624*4882a593Smuzhiyun }
625*4882a593Smuzhiyun 
626*4882a593Smuzhiyun static DEVICE_ATTR_WO(device_remove);
627*4882a593Smuzhiyun 
poll_interval_ns_show(struct device * dev,struct device_attribute * attr,char * buf)628*4882a593Smuzhiyun static ssize_t poll_interval_ns_show(struct device *dev,
629*4882a593Smuzhiyun 				     struct device_attribute *attr, char *buf)
630*4882a593Smuzhiyun {
631*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
632*4882a593Smuzhiyun 
633*4882a593Smuzhiyun 	return sprintf(buf, "%lld\n", jiffies_to_nsecs(smaster->poll_interval));
634*4882a593Smuzhiyun }
635*4882a593Smuzhiyun 
poll_interval_ns_store(struct device * dev,struct device_attribute * attr,const char * buf,size_t count)636*4882a593Smuzhiyun static ssize_t poll_interval_ns_store(struct device *dev,
637*4882a593Smuzhiyun 				      struct device_attribute *attr,
638*4882a593Smuzhiyun 				      const char *buf, size_t count)
639*4882a593Smuzhiyun {
640*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
641*4882a593Smuzhiyun 	int ret;
642*4882a593Smuzhiyun 	u64 val;
643*4882a593Smuzhiyun 
644*4882a593Smuzhiyun 	ret = kstrtou64(buf, 0, &val);
645*4882a593Smuzhiyun 	if (ret < 0)
646*4882a593Smuzhiyun 		return ret;
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	siox_master_lock(smaster);
649*4882a593Smuzhiyun 
650*4882a593Smuzhiyun 	smaster->poll_interval = nsecs_to_jiffies(val);
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	siox_master_unlock(smaster);
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun 	return count;
655*4882a593Smuzhiyun }
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun static DEVICE_ATTR_RW(poll_interval_ns);
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun static struct attribute *siox_master_attrs[] = {
660*4882a593Smuzhiyun 	&dev_attr_active.attr,
661*4882a593Smuzhiyun 	&dev_attr_device_add.attr,
662*4882a593Smuzhiyun 	&dev_attr_device_remove.attr,
663*4882a593Smuzhiyun 	&dev_attr_poll_interval_ns.attr,
664*4882a593Smuzhiyun 	NULL
665*4882a593Smuzhiyun };
666*4882a593Smuzhiyun ATTRIBUTE_GROUPS(siox_master);
667*4882a593Smuzhiyun 
siox_master_release(struct device * dev)668*4882a593Smuzhiyun static void siox_master_release(struct device *dev)
669*4882a593Smuzhiyun {
670*4882a593Smuzhiyun 	struct siox_master *smaster = to_siox_master(dev);
671*4882a593Smuzhiyun 
672*4882a593Smuzhiyun 	kfree(smaster);
673*4882a593Smuzhiyun }
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun static struct device_type siox_master_type = {
676*4882a593Smuzhiyun 	.groups = siox_master_groups,
677*4882a593Smuzhiyun 	.release = siox_master_release,
678*4882a593Smuzhiyun };
679*4882a593Smuzhiyun 
siox_master_alloc(struct device * dev,size_t size)680*4882a593Smuzhiyun struct siox_master *siox_master_alloc(struct device *dev,
681*4882a593Smuzhiyun 				      size_t size)
682*4882a593Smuzhiyun {
683*4882a593Smuzhiyun 	struct siox_master *smaster;
684*4882a593Smuzhiyun 
685*4882a593Smuzhiyun 	if (!dev)
686*4882a593Smuzhiyun 		return NULL;
687*4882a593Smuzhiyun 
688*4882a593Smuzhiyun 	smaster = kzalloc(sizeof(*smaster) + size, GFP_KERNEL);
689*4882a593Smuzhiyun 	if (!smaster)
690*4882a593Smuzhiyun 		return NULL;
691*4882a593Smuzhiyun 
692*4882a593Smuzhiyun 	device_initialize(&smaster->dev);
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	smaster->busno = -1;
695*4882a593Smuzhiyun 	smaster->dev.bus = &siox_bus_type;
696*4882a593Smuzhiyun 	smaster->dev.type = &siox_master_type;
697*4882a593Smuzhiyun 	smaster->dev.parent = dev;
698*4882a593Smuzhiyun 	smaster->poll_interval = DIV_ROUND_UP(HZ, 40);
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 	dev_set_drvdata(&smaster->dev, &smaster[1]);
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 	return smaster;
703*4882a593Smuzhiyun }
704*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(siox_master_alloc);
705*4882a593Smuzhiyun 
siox_master_register(struct siox_master * smaster)706*4882a593Smuzhiyun int siox_master_register(struct siox_master *smaster)
707*4882a593Smuzhiyun {
708*4882a593Smuzhiyun 	int ret;
709*4882a593Smuzhiyun 
710*4882a593Smuzhiyun 	if (!siox_is_registered)
711*4882a593Smuzhiyun 		return -EPROBE_DEFER;
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun 	if (!smaster->pushpull)
714*4882a593Smuzhiyun 		return -EINVAL;
715*4882a593Smuzhiyun 
716*4882a593Smuzhiyun 	dev_set_name(&smaster->dev, "siox-%d", smaster->busno);
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	mutex_init(&smaster->lock);
719*4882a593Smuzhiyun 	INIT_LIST_HEAD(&smaster->devices);
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	smaster->last_poll = jiffies;
722*4882a593Smuzhiyun 	smaster->poll_thread = kthread_run(siox_poll_thread, smaster,
723*4882a593Smuzhiyun 					   "siox-%d", smaster->busno);
724*4882a593Smuzhiyun 	if (IS_ERR(smaster->poll_thread)) {
725*4882a593Smuzhiyun 		smaster->active = 0;
726*4882a593Smuzhiyun 		return PTR_ERR(smaster->poll_thread);
727*4882a593Smuzhiyun 	}
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	ret = device_add(&smaster->dev);
730*4882a593Smuzhiyun 	if (ret)
731*4882a593Smuzhiyun 		kthread_stop(smaster->poll_thread);
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	return ret;
734*4882a593Smuzhiyun }
735*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(siox_master_register);
736*4882a593Smuzhiyun 
siox_master_unregister(struct siox_master * smaster)737*4882a593Smuzhiyun void siox_master_unregister(struct siox_master *smaster)
738*4882a593Smuzhiyun {
739*4882a593Smuzhiyun 	/* remove device */
740*4882a593Smuzhiyun 	device_del(&smaster->dev);
741*4882a593Smuzhiyun 
742*4882a593Smuzhiyun 	siox_master_lock(smaster);
743*4882a593Smuzhiyun 
744*4882a593Smuzhiyun 	__siox_stop(smaster);
745*4882a593Smuzhiyun 
746*4882a593Smuzhiyun 	while (smaster->num_devices) {
747*4882a593Smuzhiyun 		struct siox_device *sdevice;
748*4882a593Smuzhiyun 
749*4882a593Smuzhiyun 		sdevice = container_of(smaster->devices.prev,
750*4882a593Smuzhiyun 				       struct siox_device, node);
751*4882a593Smuzhiyun 		list_del(&sdevice->node);
752*4882a593Smuzhiyun 		smaster->num_devices--;
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 		siox_master_unlock(smaster);
755*4882a593Smuzhiyun 
756*4882a593Smuzhiyun 		device_unregister(&sdevice->dev);
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun 		siox_master_lock(smaster);
759*4882a593Smuzhiyun 	}
760*4882a593Smuzhiyun 
761*4882a593Smuzhiyun 	siox_master_unlock(smaster);
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	put_device(&smaster->dev);
764*4882a593Smuzhiyun }
765*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(siox_master_unregister);
766*4882a593Smuzhiyun 
siox_device_add(struct siox_master * smaster,const char * type,size_t inbytes,size_t outbytes,u8 statustype)767*4882a593Smuzhiyun static struct siox_device *siox_device_add(struct siox_master *smaster,
768*4882a593Smuzhiyun 					   const char *type, size_t inbytes,
769*4882a593Smuzhiyun 					   size_t outbytes, u8 statustype)
770*4882a593Smuzhiyun {
771*4882a593Smuzhiyun 	struct siox_device *sdevice;
772*4882a593Smuzhiyun 	int ret;
773*4882a593Smuzhiyun 	size_t buf_len;
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 	sdevice = kzalloc(sizeof(*sdevice), GFP_KERNEL);
776*4882a593Smuzhiyun 	if (!sdevice)
777*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
778*4882a593Smuzhiyun 
779*4882a593Smuzhiyun 	sdevice->type = type;
780*4882a593Smuzhiyun 	sdevice->inbytes = inbytes;
781*4882a593Smuzhiyun 	sdevice->outbytes = outbytes;
782*4882a593Smuzhiyun 	sdevice->statustype = statustype;
783*4882a593Smuzhiyun 
784*4882a593Smuzhiyun 	sdevice->smaster = smaster;
785*4882a593Smuzhiyun 	sdevice->dev.parent = &smaster->dev;
786*4882a593Smuzhiyun 	sdevice->dev.bus = &siox_bus_type;
787*4882a593Smuzhiyun 	sdevice->dev.type = &siox_device_type;
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun 	siox_master_lock(smaster);
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	dev_set_name(&sdevice->dev, "siox-%d-%d",
792*4882a593Smuzhiyun 		     smaster->busno, smaster->num_devices);
793*4882a593Smuzhiyun 
794*4882a593Smuzhiyun 	buf_len = smaster->setbuf_len + inbytes +
795*4882a593Smuzhiyun 		smaster->getbuf_len + outbytes;
796*4882a593Smuzhiyun 	if (smaster->buf_len < buf_len) {
797*4882a593Smuzhiyun 		u8 *buf = krealloc(smaster->buf, buf_len, GFP_KERNEL);
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 		if (!buf) {
800*4882a593Smuzhiyun 			dev_err(&smaster->dev,
801*4882a593Smuzhiyun 				"failed to realloc buffer to %zu\n", buf_len);
802*4882a593Smuzhiyun 			ret = -ENOMEM;
803*4882a593Smuzhiyun 			goto err_buf_alloc;
804*4882a593Smuzhiyun 		}
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 		smaster->buf_len = buf_len;
807*4882a593Smuzhiyun 		smaster->buf = buf;
808*4882a593Smuzhiyun 	}
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	ret = device_register(&sdevice->dev);
811*4882a593Smuzhiyun 	if (ret) {
812*4882a593Smuzhiyun 		dev_err(&smaster->dev, "failed to register device: %d\n", ret);
813*4882a593Smuzhiyun 
814*4882a593Smuzhiyun 		goto err_device_register;
815*4882a593Smuzhiyun 	}
816*4882a593Smuzhiyun 
817*4882a593Smuzhiyun 	smaster->num_devices++;
818*4882a593Smuzhiyun 	list_add_tail(&sdevice->node, &smaster->devices);
819*4882a593Smuzhiyun 
820*4882a593Smuzhiyun 	smaster->setbuf_len += sdevice->inbytes;
821*4882a593Smuzhiyun 	smaster->getbuf_len += sdevice->outbytes;
822*4882a593Smuzhiyun 
823*4882a593Smuzhiyun 	sdevice->status_errors_kn = sysfs_get_dirent(sdevice->dev.kobj.sd,
824*4882a593Smuzhiyun 						     "status_errors");
825*4882a593Smuzhiyun 	sdevice->watchdog_kn = sysfs_get_dirent(sdevice->dev.kobj.sd,
826*4882a593Smuzhiyun 						"watchdog");
827*4882a593Smuzhiyun 	sdevice->watchdog_errors_kn = sysfs_get_dirent(sdevice->dev.kobj.sd,
828*4882a593Smuzhiyun 						       "watchdog_errors");
829*4882a593Smuzhiyun 	sdevice->connected_kn = sysfs_get_dirent(sdevice->dev.kobj.sd,
830*4882a593Smuzhiyun 						 "connected");
831*4882a593Smuzhiyun 
832*4882a593Smuzhiyun 	siox_master_unlock(smaster);
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun 	return sdevice;
835*4882a593Smuzhiyun 
836*4882a593Smuzhiyun err_device_register:
837*4882a593Smuzhiyun 	/* don't care to make the buffer smaller again */
838*4882a593Smuzhiyun 	put_device(&sdevice->dev);
839*4882a593Smuzhiyun 	sdevice = NULL;
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun err_buf_alloc:
842*4882a593Smuzhiyun 	siox_master_unlock(smaster);
843*4882a593Smuzhiyun 
844*4882a593Smuzhiyun 	kfree(sdevice);
845*4882a593Smuzhiyun 
846*4882a593Smuzhiyun 	return ERR_PTR(ret);
847*4882a593Smuzhiyun }
848*4882a593Smuzhiyun 
siox_device_remove(struct siox_master * smaster)849*4882a593Smuzhiyun static void siox_device_remove(struct siox_master *smaster)
850*4882a593Smuzhiyun {
851*4882a593Smuzhiyun 	struct siox_device *sdevice;
852*4882a593Smuzhiyun 
853*4882a593Smuzhiyun 	siox_master_lock(smaster);
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun 	if (!smaster->num_devices) {
856*4882a593Smuzhiyun 		siox_master_unlock(smaster);
857*4882a593Smuzhiyun 		return;
858*4882a593Smuzhiyun 	}
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun 	sdevice = container_of(smaster->devices.prev, struct siox_device, node);
861*4882a593Smuzhiyun 	list_del(&sdevice->node);
862*4882a593Smuzhiyun 	smaster->num_devices--;
863*4882a593Smuzhiyun 
864*4882a593Smuzhiyun 	smaster->setbuf_len -= sdevice->inbytes;
865*4882a593Smuzhiyun 	smaster->getbuf_len -= sdevice->outbytes;
866*4882a593Smuzhiyun 
867*4882a593Smuzhiyun 	if (!smaster->num_devices)
868*4882a593Smuzhiyun 		__siox_stop(smaster);
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun 	siox_master_unlock(smaster);
871*4882a593Smuzhiyun 
872*4882a593Smuzhiyun 	/*
873*4882a593Smuzhiyun 	 * This must be done without holding the master lock because we're
874*4882a593Smuzhiyun 	 * called from device_remove_store which also holds a sysfs mutex.
875*4882a593Smuzhiyun 	 * device_unregister tries to aquire the same lock.
876*4882a593Smuzhiyun 	 */
877*4882a593Smuzhiyun 	device_unregister(&sdevice->dev);
878*4882a593Smuzhiyun }
879*4882a593Smuzhiyun 
__siox_driver_register(struct siox_driver * sdriver,struct module * owner)880*4882a593Smuzhiyun int __siox_driver_register(struct siox_driver *sdriver, struct module *owner)
881*4882a593Smuzhiyun {
882*4882a593Smuzhiyun 	int ret;
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	if (unlikely(!siox_is_registered))
885*4882a593Smuzhiyun 		return -EPROBE_DEFER;
886*4882a593Smuzhiyun 
887*4882a593Smuzhiyun 	if (!sdriver->set_data && !sdriver->get_data) {
888*4882a593Smuzhiyun 		pr_err("Driver %s doesn't provide needed callbacks\n",
889*4882a593Smuzhiyun 		       sdriver->driver.name);
890*4882a593Smuzhiyun 		return -EINVAL;
891*4882a593Smuzhiyun 	}
892*4882a593Smuzhiyun 
893*4882a593Smuzhiyun 	sdriver->driver.owner = owner;
894*4882a593Smuzhiyun 	sdriver->driver.bus = &siox_bus_type;
895*4882a593Smuzhiyun 
896*4882a593Smuzhiyun 	if (sdriver->probe)
897*4882a593Smuzhiyun 		sdriver->driver.probe = siox_driver_probe;
898*4882a593Smuzhiyun 	if (sdriver->remove)
899*4882a593Smuzhiyun 		sdriver->driver.remove = siox_driver_remove;
900*4882a593Smuzhiyun 	if (sdriver->shutdown)
901*4882a593Smuzhiyun 		sdriver->driver.shutdown = siox_driver_shutdown;
902*4882a593Smuzhiyun 
903*4882a593Smuzhiyun 	ret = driver_register(&sdriver->driver);
904*4882a593Smuzhiyun 	if (ret)
905*4882a593Smuzhiyun 		pr_err("Failed to register siox driver %s (%d)\n",
906*4882a593Smuzhiyun 		       sdriver->driver.name, ret);
907*4882a593Smuzhiyun 
908*4882a593Smuzhiyun 	return ret;
909*4882a593Smuzhiyun }
910*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(__siox_driver_register);
911*4882a593Smuzhiyun 
siox_init(void)912*4882a593Smuzhiyun static int __init siox_init(void)
913*4882a593Smuzhiyun {
914*4882a593Smuzhiyun 	int ret;
915*4882a593Smuzhiyun 
916*4882a593Smuzhiyun 	ret = bus_register(&siox_bus_type);
917*4882a593Smuzhiyun 	if (ret) {
918*4882a593Smuzhiyun 		pr_err("Registration of SIOX bus type failed: %d\n", ret);
919*4882a593Smuzhiyun 		return ret;
920*4882a593Smuzhiyun 	}
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun 	siox_is_registered = true;
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	return 0;
925*4882a593Smuzhiyun }
926*4882a593Smuzhiyun subsys_initcall(siox_init);
927*4882a593Smuzhiyun 
siox_exit(void)928*4882a593Smuzhiyun static void __exit siox_exit(void)
929*4882a593Smuzhiyun {
930*4882a593Smuzhiyun 	bus_unregister(&siox_bus_type);
931*4882a593Smuzhiyun }
932*4882a593Smuzhiyun module_exit(siox_exit);
933*4882a593Smuzhiyun 
934*4882a593Smuzhiyun MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>");
935*4882a593Smuzhiyun MODULE_DESCRIPTION("Eckelmann SIOX driver core");
936*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
937