^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) i2c-dev.c - i2c-bus driver, char device interface
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) Copyright (C) 1995-97 Simon G. Vogl
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) Copyright (C) 1998-99 Frodo Looijaard <frodol@dds.nl>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) Copyright (C) 2003 Greg Kroah-Hartman <greg@kroah.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) /* Note that this is a complete rewrite of Simon Vogl's i2c-dev module.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) But I have used so much of his original code and ideas that it seems
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) only fair to recognize him as co-author -- Frodo */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) /* The I2C_RDWR ioctl code is written by Kolja Waschk <waschk@telos.de> */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/cdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/compat.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/fs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/i2c-dev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/list.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/notifier.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * An i2c_dev represents an i2c_adapter ... an I2C or SMBus master, not a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * slave (i2c_client) with which messages will be exchanged. It's coupled
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * with a character special file which is accessed by user mode drivers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) * The list of i2c_dev structures is parallel to the i2c_adapter lists
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) * maintained by the driver model, and is updated using bus notifications.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) struct i2c_dev {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct list_head list;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) struct i2c_adapter *adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) struct device dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct cdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define I2C_MINORS (MINORMASK + 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) static LIST_HEAD(i2c_dev_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static DEFINE_SPINLOCK(i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) static struct i2c_dev *i2c_dev_get_by_minor(unsigned index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) struct i2c_dev *i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) spin_lock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) list_for_each_entry(i2c_dev, &i2c_dev_list, list) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) if (i2c_dev->adap->nr == index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) goto found;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) i2c_dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) found:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) spin_unlock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) return i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static struct i2c_dev *get_free_i2c_dev(struct i2c_adapter *adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct i2c_dev *i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) if (adap->nr >= I2C_MINORS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) printk(KERN_ERR "i2c-dev: Out of device minors (%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) return ERR_PTR(-ENODEV);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) i2c_dev = kzalloc(sizeof(*i2c_dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) if (!i2c_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) i2c_dev->adap = adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) spin_lock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) list_add_tail(&i2c_dev->list, &i2c_dev_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) spin_unlock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) return i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static void put_i2c_dev(struct i2c_dev *i2c_dev, bool del_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) spin_lock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) list_del(&i2c_dev->list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) spin_unlock(&i2c_dev_list_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) if (del_cdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) cdev_device_del(&i2c_dev->cdev, &i2c_dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) put_device(&i2c_dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) static ssize_t name_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) struct i2c_dev *i2c_dev = i2c_dev_get_by_minor(MINOR(dev->devt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (!i2c_dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return sprintf(buf, "%s\n", i2c_dev->adap->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) static DEVICE_ATTR_RO(name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static struct attribute *i2c_attrs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) &dev_attr_name.attr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) ATTRIBUTE_GROUPS(i2c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* ------------------------------------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) * After opening an instance of this character special file, a file
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) * descriptor starts out associated only with an i2c_adapter (and bus).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) * Using the I2C_RDWR ioctl(), you can then *immediately* issue i2c_msg
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) * traffic to any devices on the bus used by that adapter. That's because
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) * the i2c_msg vectors embed all the addressing information they need, and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) * are submitted directly to an i2c_adapter. However, SMBus-only adapters
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) * don't support that interface.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) * To use read()/write() system calls on that file descriptor, or to use
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) * SMBus interfaces (and work with SMBus-only hosts!), you must first issue
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) * an I2C_SLAVE (or I2C_SLAVE_FORCE) ioctl. That configures an anonymous
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) * (never registered) i2c_client so it holds the addressing information
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) * needed by those system calls and by this SMBus interface.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) static ssize_t i2cdev_read(struct file *file, char __user *buf, size_t count,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) loff_t *offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) char *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) struct i2c_client *client = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (count > 8192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) count = 8192;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) tmp = kzalloc(count, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) if (tmp == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) pr_debug("i2c-dev: i2c-%d reading %zu bytes.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) iminor(file_inode(file)), count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) ret = i2c_master_recv(client, tmp, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (copy_to_user(buf, tmp, ret))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) ret = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) kfree(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) static ssize_t i2cdev_write(struct file *file, const char __user *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) size_t count, loff_t *offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) char *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) struct i2c_client *client = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (count > 8192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) count = 8192;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) tmp = memdup_user(buf, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (IS_ERR(tmp))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return PTR_ERR(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) pr_debug("i2c-dev: i2c-%d writing %zu bytes.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) iminor(file_inode(file)), count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) ret = i2c_master_send(client, tmp, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) kfree(tmp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) static int i2cdev_check(struct device *dev, void *addrp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) struct i2c_client *client = i2c_verify_client(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) if (!client || client->addr != *(unsigned int *)addrp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) return dev->driver ? -EBUSY : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) /* walk up mux tree */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) static int i2cdev_check_mux_parents(struct i2c_adapter *adapter, int addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) result = device_for_each_child(&adapter->dev, &addr, i2cdev_check);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) if (!result && parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) result = i2cdev_check_mux_parents(parent, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) /* recurse down mux tree */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) static int i2cdev_check_mux_children(struct device *dev, void *addrp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if (dev->type == &i2c_adapter_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) result = device_for_each_child(dev, addrp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) i2cdev_check_mux_children);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) result = i2cdev_check(dev, addrp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) /* This address checking function differs from the one in i2c-core
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) in that it considers an address with a registered device, but no
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) driver bound to it, as NOT busy. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) static int i2cdev_check_addr(struct i2c_adapter *adapter, unsigned int addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) struct i2c_adapter *parent = i2c_parent_is_i2c_adapter(adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) int result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) if (parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) result = i2cdev_check_mux_parents(parent, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) if (!result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) result = device_for_each_child(&adapter->dev, &addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) i2cdev_check_mux_children);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) static noinline int i2cdev_ioctl_rdwr(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) unsigned nmsgs, struct i2c_msg *msgs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) u8 __user **data_ptrs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) int i, res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) data_ptrs = kmalloc_array(nmsgs, sizeof(u8 __user *), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (data_ptrs == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) kfree(msgs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) res = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) for (i = 0; i < nmsgs; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) /* Limit the size of the message to a sane amount */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if (msgs[i].len > 8192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) res = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) data_ptrs[i] = (u8 __user *)msgs[i].buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) msgs[i].buf = memdup_user(data_ptrs[i], msgs[i].len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) if (IS_ERR(msgs[i].buf)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) res = PTR_ERR(msgs[i].buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) /* memdup_user allocates with GFP_KERNEL, so DMA is ok */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) msgs[i].flags |= I2C_M_DMA_SAFE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) * If the message length is received from the slave (similar
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) * to SMBus block read), we must ensure that the buffer will
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) * be large enough to cope with a message length of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) * I2C_SMBUS_BLOCK_MAX as this is the maximum underlying bus
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) * drivers allow. The first byte in the buffer must be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) * pre-filled with the number of extra bytes, which must be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) * at least one to hold the message length, but can be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) * greater (for example to account for a checksum byte at
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) * the end of the message.)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) if (msgs[i].flags & I2C_M_RECV_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) if (!(msgs[i].flags & I2C_M_RD) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) msgs[i].len < 1 || msgs[i].buf[0] < 1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) msgs[i].len < msgs[i].buf[0] +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) I2C_SMBUS_BLOCK_MAX) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) res = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) msgs[i].len = msgs[i].buf[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) if (res < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) int j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) for (j = 0; j < i; ++j)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) kfree(msgs[j].buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) kfree(data_ptrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) kfree(msgs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) res = i2c_transfer(client->adapter, msgs, nmsgs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) while (i-- > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (res >= 0 && (msgs[i].flags & I2C_M_RD)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (copy_to_user(data_ptrs[i], msgs[i].buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) msgs[i].len))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) res = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) kfree(msgs[i].buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) kfree(data_ptrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) kfree(msgs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) static noinline int i2cdev_ioctl_smbus(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) u8 read_write, u8 command, u32 size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) union i2c_smbus_data __user *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) union i2c_smbus_data temp = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) int datasize, res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) if ((size != I2C_SMBUS_BYTE) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) (size != I2C_SMBUS_QUICK) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) (size != I2C_SMBUS_BYTE_DATA) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) (size != I2C_SMBUS_WORD_DATA) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) (size != I2C_SMBUS_PROC_CALL) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) (size != I2C_SMBUS_BLOCK_DATA) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) (size != I2C_SMBUS_I2C_BLOCK_BROKEN) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) (size != I2C_SMBUS_I2C_BLOCK_DATA) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) (size != I2C_SMBUS_BLOCK_PROC_CALL)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) dev_dbg(&client->adapter->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) "size out of range (%x) in ioctl I2C_SMBUS.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) /* Note that I2C_SMBUS_READ and I2C_SMBUS_WRITE are 0 and 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) so the check is valid if size==I2C_SMBUS_QUICK too. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if ((read_write != I2C_SMBUS_READ) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) (read_write != I2C_SMBUS_WRITE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) dev_dbg(&client->adapter->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) "read_write out of range (%x) in ioctl I2C_SMBUS.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) read_write);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) /* Note that command values are always valid! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if ((size == I2C_SMBUS_QUICK) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) ((size == I2C_SMBUS_BYTE) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) (read_write == I2C_SMBUS_WRITE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) /* These are special: we do not use data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return i2c_smbus_xfer(client->adapter, client->addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) client->flags, read_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) command, size, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) if (data == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) dev_dbg(&client->adapter->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) "data is NULL pointer in ioctl I2C_SMBUS.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) if ((size == I2C_SMBUS_BYTE_DATA) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) (size == I2C_SMBUS_BYTE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) datasize = sizeof(data->byte);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) else if ((size == I2C_SMBUS_WORD_DATA) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) (size == I2C_SMBUS_PROC_CALL))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) datasize = sizeof(data->word);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) else /* size == smbus block, i2c block, or block proc. call */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) datasize = sizeof(data->block);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if ((size == I2C_SMBUS_PROC_CALL) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) (size == I2C_SMBUS_BLOCK_PROC_CALL) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) (size == I2C_SMBUS_I2C_BLOCK_DATA) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) (read_write == I2C_SMBUS_WRITE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) if (copy_from_user(&temp, data, datasize))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (size == I2C_SMBUS_I2C_BLOCK_BROKEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) /* Convert old I2C block commands to the new
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) convention. This preserves binary compatibility. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) size = I2C_SMBUS_I2C_BLOCK_DATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) if (read_write == I2C_SMBUS_READ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) temp.block[0] = I2C_SMBUS_BLOCK_MAX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) res = i2c_smbus_xfer(client->adapter, client->addr, client->flags,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) read_write, command, size, &temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) if (!res && ((size == I2C_SMBUS_PROC_CALL) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) (size == I2C_SMBUS_BLOCK_PROC_CALL) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) (read_write == I2C_SMBUS_READ))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (copy_to_user(data, &temp, datasize))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) static long i2cdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) struct i2c_client *client = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) unsigned long funcs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) dev_dbg(&client->adapter->dev, "ioctl, cmd=0x%02x, arg=0x%02lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) case I2C_SLAVE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) case I2C_SLAVE_FORCE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) if ((arg > 0x3ff) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) (((client->flags & I2C_M_TEN) == 0) && arg > 0x7f))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) if (cmd == I2C_SLAVE && i2cdev_check_addr(client->adapter, arg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) /* REVISIT: address could become busy later */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) client->addr = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) case I2C_TENBIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) if (arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) client->flags |= I2C_M_TEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) client->flags &= ~I2C_M_TEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) case I2C_PEC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) * Setting the PEC flag here won't affect kernel drivers,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) * which will be using the i2c_client node registered with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) * the driver model core. Likewise, when that client has
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) * the PEC flag already set, the i2c-dev driver won't see
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) * (or use) this setting.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) if (arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) client->flags |= I2C_CLIENT_PEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) client->flags &= ~I2C_CLIENT_PEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) case I2C_FUNCS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) funcs = i2c_get_functionality(client->adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) return put_user(funcs, (unsigned long __user *)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) case I2C_RDWR: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) struct i2c_rdwr_ioctl_data rdwr_arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) struct i2c_msg *rdwr_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) if (copy_from_user(&rdwr_arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) (struct i2c_rdwr_ioctl_data __user *)arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) sizeof(rdwr_arg)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (!rdwr_arg.msgs || rdwr_arg.nmsgs == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) * Put an arbitrary limit on the number of messages that can
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) * be sent at once
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) if (rdwr_arg.nmsgs > I2C_RDWR_IOCTL_MAX_MSGS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) rdwr_pa = memdup_user(rdwr_arg.msgs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) rdwr_arg.nmsgs * sizeof(struct i2c_msg));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) if (IS_ERR(rdwr_pa))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) return PTR_ERR(rdwr_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) return i2cdev_ioctl_rdwr(client, rdwr_arg.nmsgs, rdwr_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) case I2C_SMBUS: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) struct i2c_smbus_ioctl_data data_arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) if (copy_from_user(&data_arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) (struct i2c_smbus_ioctl_data __user *) arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) sizeof(struct i2c_smbus_ioctl_data)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) return i2cdev_ioctl_smbus(client, data_arg.read_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) data_arg.command,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) data_arg.size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) data_arg.data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) case I2C_RETRIES:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) if (arg > INT_MAX)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) client->adapter->retries = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) case I2C_TIMEOUT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) if (arg > INT_MAX)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) /* For historical reasons, user-space sets the timeout
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) * value in units of 10 ms.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) client->adapter->timeout = msecs_to_jiffies(arg * 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) /* NOTE: returning a fault code here could cause trouble
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) * in buggy userspace code. Some old kernel bugs returned
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) * zero in this case, and userspace code might accidentally
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) * have depended on that bug.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) return -ENOTTY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) #ifdef CONFIG_COMPAT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) struct i2c_smbus_ioctl_data32 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) u8 read_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) u8 command;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) u32 size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) compat_caddr_t data; /* union i2c_smbus_data *data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) struct i2c_msg32 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) u16 addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) u16 flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) u16 len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) compat_caddr_t buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) struct i2c_rdwr_ioctl_data32 {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) compat_caddr_t msgs; /* struct i2c_msg __user *msgs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) u32 nmsgs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) static long compat_i2cdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) struct i2c_client *client = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) unsigned long funcs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) case I2C_FUNCS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) funcs = i2c_get_functionality(client->adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) return put_user(funcs, (compat_ulong_t __user *)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) case I2C_RDWR: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) struct i2c_rdwr_ioctl_data32 rdwr_arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) struct i2c_msg32 *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) struct i2c_msg *rdwr_pa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) if (copy_from_user(&rdwr_arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) (struct i2c_rdwr_ioctl_data32 __user *)arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) sizeof(rdwr_arg)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) if (!rdwr_arg.msgs || rdwr_arg.nmsgs == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (rdwr_arg.nmsgs > I2C_RDWR_IOCTL_MAX_MSGS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) rdwr_pa = kmalloc_array(rdwr_arg.nmsgs, sizeof(struct i2c_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) if (!rdwr_pa)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) p = compat_ptr(rdwr_arg.msgs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) for (i = 0; i < rdwr_arg.nmsgs; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) struct i2c_msg32 umsg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) if (copy_from_user(&umsg, p + i, sizeof(umsg))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) kfree(rdwr_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) rdwr_pa[i] = (struct i2c_msg) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) .addr = umsg.addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) .flags = umsg.flags,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) .len = umsg.len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) .buf = compat_ptr(umsg.buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) return i2cdev_ioctl_rdwr(client, rdwr_arg.nmsgs, rdwr_pa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) case I2C_SMBUS: {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) struct i2c_smbus_ioctl_data32 data32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) if (copy_from_user(&data32,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) (void __user *) arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) sizeof(data32)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) return i2cdev_ioctl_smbus(client, data32.read_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) data32.command,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) data32.size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) compat_ptr(data32.data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) return i2cdev_ioctl(file, cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) #define compat_i2cdev_ioctl NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) static int i2cdev_open(struct inode *inode, struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) unsigned int minor = iminor(inode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) struct i2c_client *client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) struct i2c_adapter *adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) adap = i2c_get_adapter(minor);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) if (!adap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) /* This creates an anonymous i2c_client, which may later be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) * pointed to some address using I2C_SLAVE or I2C_SLAVE_FORCE.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) * This client is ** NEVER REGISTERED ** with the driver model
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) * or I2C core code!! It just holds private copies of addressing
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) * information and maybe a PEC flag.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) client = kzalloc(sizeof(*client), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) if (!client) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) i2c_put_adapter(adap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) snprintf(client->name, I2C_NAME_SIZE, "i2c-dev %d", adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) client->adapter = adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) file->private_data = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) static int i2cdev_release(struct inode *inode, struct file *file)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) struct i2c_client *client = file->private_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) i2c_put_adapter(client->adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) kfree(client);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) file->private_data = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) static const struct file_operations i2cdev_fops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) .llseek = no_llseek,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) .read = i2cdev_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) .write = i2cdev_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) .unlocked_ioctl = i2cdev_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) .compat_ioctl = compat_i2cdev_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) .open = i2cdev_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) .release = i2cdev_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) /* ------------------------------------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) static struct class *i2c_dev_class;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) static void i2cdev_dev_release(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) struct i2c_dev *i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) i2c_dev = container_of(dev, struct i2c_dev, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) kfree(i2c_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) static int i2cdev_attach_adapter(struct device *dev, void *dummy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) struct i2c_adapter *adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) struct i2c_dev *i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) if (dev->type != &i2c_adapter_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) adap = to_i2c_adapter(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) i2c_dev = get_free_i2c_dev(adap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) if (IS_ERR(i2c_dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) return PTR_ERR(i2c_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) cdev_init(&i2c_dev->cdev, &i2cdev_fops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) i2c_dev->cdev.owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) device_initialize(&i2c_dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) i2c_dev->dev.devt = MKDEV(I2C_MAJOR, adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) i2c_dev->dev.class = i2c_dev_class;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) i2c_dev->dev.parent = &adap->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) i2c_dev->dev.release = i2cdev_dev_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) dev_set_name(&i2c_dev->dev, "i2c-%d", adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) res = cdev_device_add(&i2c_dev->cdev, &i2c_dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) if (res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) put_i2c_dev(i2c_dev, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) pr_debug("i2c-dev: adapter [%s] registered as minor %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) adap->name, adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) static int i2cdev_detach_adapter(struct device *dev, void *dummy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) struct i2c_adapter *adap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) struct i2c_dev *i2c_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) if (dev->type != &i2c_adapter_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) adap = to_i2c_adapter(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) i2c_dev = i2c_dev_get_by_minor(adap->nr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) if (!i2c_dev) /* attach_adapter must have failed */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) put_i2c_dev(i2c_dev, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) pr_debug("i2c-dev: adapter [%s] unregistered\n", adap->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) static int i2cdev_notifier_call(struct notifier_block *nb, unsigned long action,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) struct device *dev = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) switch (action) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) case BUS_NOTIFY_ADD_DEVICE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) return i2cdev_attach_adapter(dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) case BUS_NOTIFY_DEL_DEVICE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) return i2cdev_detach_adapter(dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) static struct notifier_block i2cdev_notifier = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) .notifier_call = i2cdev_notifier_call,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) /* ------------------------------------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) * module load/unload record keeping
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) static int __init i2c_dev_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) int res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) printk(KERN_INFO "i2c /dev entries driver\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) res = register_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS, "i2c");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) i2c_dev_class = class_create(THIS_MODULE, "i2c-dev");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) if (IS_ERR(i2c_dev_class)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) res = PTR_ERR(i2c_dev_class);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) goto out_unreg_chrdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) i2c_dev_class->dev_groups = i2c_groups;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) /* Keep track of adapters which will be added or removed later */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) res = bus_register_notifier(&i2c_bus_type, &i2cdev_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) goto out_unreg_class;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) /* Bind to already existing adapters right away */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) i2c_for_each_dev(NULL, i2cdev_attach_adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) out_unreg_class:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) class_destroy(i2c_dev_class);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) out_unreg_chrdev:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) unregister_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) printk(KERN_ERR "%s: Driver Initialisation failed\n", __FILE__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) static void __exit i2c_dev_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) bus_unregister_notifier(&i2c_bus_type, &i2cdev_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) i2c_for_each_dev(NULL, i2cdev_detach_adapter);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) class_destroy(i2c_dev_class);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) unregister_chrdev_region(MKDEV(I2C_MAJOR, 0), I2C_MINORS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) MODULE_AUTHOR("Simon G. Vogl <simon@tk.uni-linz.ac.at>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) MODULE_DESCRIPTION("I2C /dev entries driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) module_init(i2c_dev_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) module_exit(i2c_dev_exit);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags