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