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