| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * Copyright (C) 2018 Cadence Design Systems Inc. | |
| * | |
| * Author: Boris Brezillon <boris.brezillon@bootlin.com> | |
| */ | |
| #include <linux/atomic.h> | |
| #include <linux/bug.h> | |
| #include <linux/completion.h> | |
| #include <linux/device.h> | |
| #include <linux/mutex.h> | |
| #include <linux/slab.h> | |
| #include "internals.h" | |
| /** | |
| * i3c_device_do_xfers() - do I3C transfers directed to a specific device | |
| * | |
| * @dev: device with which the transfers should be done | |
| * @xfers: array of transfers | |
| * @nxfers: number of transfers | |
| * @mode: transfer mode | |
| * | |
| * Initiate one or several private SDR transfers with @dev. | |
| * | |
| * This function can sleep and thus cannot be called in atomic context. | |
| * | |
| * Return: | |
| * * 0 in case of success, a negative error core otherwise. | |
| * * -EAGAIN: controller lost address arbitration. Target (IBI, HJ or | |
| * controller role request) win the bus. Client driver needs to resend the | |
| * 'xfers' some time later. See I3C spec ver 1.1.1 09-Jun-2021. Section: | |
| * 5.1.2.2.3. | |
| */ | |
| int i3c_device_do_xfers(struct i3c_device *dev, struct i3c_xfer *xfers, | |
| int nxfers, enum i3c_xfer_mode mode) | |
| { | |
| int ret, i; | |
| if (nxfers < 1) | |
| return 0; | |
| for (i = 0; i < nxfers; i++) { | |
| if (!xfers[i].len || !xfers[i].data.in) | |
| return -EINVAL; | |
| } | |
| ret = i3c_bus_rpm_get(dev->bus); | |
| if (ret) | |
| return ret; | |
| i3c_bus_normaluse_lock(dev->bus); | |
| ret = i3c_dev_do_xfers_locked(dev->desc, xfers, nxfers, mode); | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| i3c_bus_rpm_put(dev->bus); | |
| return ret; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_do_xfers); | |
| /** | |
| * i3c_device_do_setdasa() - do I3C dynamic address assignement with | |
| * static address | |
| * | |
| * @dev: device with which the DAA should be done | |
| * | |
| * Return: 0 in case of success, a negative error core otherwise. | |
| */ | |
| int i3c_device_do_setdasa(struct i3c_device *dev) | |
| { | |
| int ret; | |
| ret = i3c_bus_rpm_get(dev->bus); | |
| if (ret) | |
| return ret; | |
| i3c_bus_normaluse_lock(dev->bus); | |
| ret = i3c_dev_setdasa_locked(dev->desc); | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| i3c_bus_rpm_put(dev->bus); | |
| return ret; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_do_setdasa); | |
| /** | |
| * i3c_device_get_info() - get I3C device information | |
| * | |
| * @dev: device we want information on | |
| * @info: the information object to fill in | |
| * | |
| * Retrieve I3C dev info. | |
| */ | |
| void i3c_device_get_info(const struct i3c_device *dev, | |
| struct i3c_device_info *info) | |
| { | |
| if (!info) | |
| return; | |
| i3c_bus_normaluse_lock(dev->bus); | |
| if (dev->desc) | |
| *info = dev->desc->info; | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_get_info); | |
| /** | |
| * i3c_device_disable_ibi() - Disable IBIs coming from a specific device | |
| * @dev: device on which IBIs should be disabled | |
| * | |
| * This function disable IBIs coming from a specific device and wait for | |
| * all pending IBIs to be processed. | |
| * | |
| * Return: 0 in case of success, a negative error core otherwise. | |
| */ | |
| int i3c_device_disable_ibi(struct i3c_device *dev) | |
| { | |
| int ret; | |
| if (i3c_bus_rpm_ibi_allowed(dev->bus)) { | |
| ret = i3c_bus_rpm_get(dev->bus); | |
| if (ret) | |
| return ret; | |
| } | |
| i3c_bus_normaluse_lock(dev->bus); | |
| if (dev->desc) { | |
| mutex_lock(&dev->desc->ibi_lock); | |
| ret = i3c_dev_disable_ibi_locked(dev->desc); | |
| mutex_unlock(&dev->desc->ibi_lock); | |
| } else { | |
| ret = -ENOENT; | |
| } | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| if (!ret || i3c_bus_rpm_ibi_allowed(dev->bus)) | |
| i3c_bus_rpm_put(dev->bus); | |
| return ret; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_disable_ibi); | |
| /** | |
| * i3c_device_enable_ibi() - Enable IBIs coming from a specific device | |
| * @dev: device on which IBIs should be enabled | |
| * | |
| * This function enable IBIs coming from a specific device and wait for | |
| * all pending IBIs to be processed. This should be called on a device | |
| * where i3c_device_request_ibi() has succeeded. | |
| * | |
| * Note that IBIs from this device might be received before this function | |
| * returns to its caller. | |
| * | |
| * Return: 0 in case of success, a negative error core otherwise. | |
| */ | |
| int i3c_device_enable_ibi(struct i3c_device *dev) | |
| { | |
| int ret; | |
| ret = i3c_bus_rpm_get(dev->bus); | |
| if (ret) | |
| return ret; | |
| i3c_bus_normaluse_lock(dev->bus); | |
| if (dev->desc) { | |
| mutex_lock(&dev->desc->ibi_lock); | |
| ret = i3c_dev_enable_ibi_locked(dev->desc); | |
| mutex_unlock(&dev->desc->ibi_lock); | |
| } else { | |
| ret = -ENOENT; | |
| } | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| if (ret || i3c_bus_rpm_ibi_allowed(dev->bus)) | |
| i3c_bus_rpm_put(dev->bus); | |
| return ret; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_enable_ibi); | |
| /** | |
| * i3c_device_request_ibi() - Request an IBI | |
| * @dev: device for which we should enable IBIs | |
| * @req: setup requested for this IBI | |
| * | |
| * This function is responsible for pre-allocating all resources needed to | |
| * process IBIs coming from @dev. When this function returns, the IBI is not | |
| * enabled until i3c_device_enable_ibi() is called. | |
| * | |
| * Return: 0 in case of success, a negative error core otherwise. | |
| */ | |
| int i3c_device_request_ibi(struct i3c_device *dev, | |
| const struct i3c_ibi_setup *req) | |
| { | |
| int ret; | |
| if (!req->handler || !req->num_slots) | |
| return -EINVAL; | |
| ret = i3c_bus_rpm_get(dev->bus); | |
| if (ret) | |
| return ret; | |
| i3c_bus_normaluse_lock(dev->bus); | |
| if (dev->desc) { | |
| mutex_lock(&dev->desc->ibi_lock); | |
| ret = i3c_dev_request_ibi_locked(dev->desc, req); | |
| mutex_unlock(&dev->desc->ibi_lock); | |
| } else { | |
| ret = -ENOENT; | |
| } | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| i3c_bus_rpm_put(dev->bus); | |
| return ret; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_request_ibi); | |
| /** | |
| * i3c_device_free_ibi() - Free all resources needed for IBI handling | |
| * @dev: device on which you want to release IBI resources | |
| * | |
| * This function is responsible for de-allocating resources previously | |
| * allocated by i3c_device_request_ibi(). It should be called after disabling | |
| * IBIs with i3c_device_disable_ibi(). | |
| */ | |
| void i3c_device_free_ibi(struct i3c_device *dev) | |
| { | |
| i3c_bus_normaluse_lock(dev->bus); | |
| if (dev->desc) { | |
| mutex_lock(&dev->desc->ibi_lock); | |
| i3c_dev_free_ibi_locked(dev->desc); | |
| mutex_unlock(&dev->desc->ibi_lock); | |
| } | |
| i3c_bus_normaluse_unlock(dev->bus); | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_free_ibi); | |
| /** | |
| * i3cdev_to_dev() - Returns the device embedded in @i3cdev | |
| * @i3cdev: I3C device | |
| * | |
| * Return: a pointer to a device object. | |
| */ | |
| struct device *i3cdev_to_dev(struct i3c_device *i3cdev) | |
| { | |
| return &i3cdev->dev; | |
| } | |
| EXPORT_SYMBOL_GPL(i3cdev_to_dev); | |
| /** | |
| * i3c_device_match_id() - Returns the i3c_device_id entry matching @i3cdev | |
| * @i3cdev: I3C device | |
| * @id_table: I3C device match table | |
| * | |
| * Return: a pointer to an i3c_device_id object or NULL if there's no match. | |
| */ | |
| const struct i3c_device_id * | |
| i3c_device_match_id(struct i3c_device *i3cdev, | |
| const struct i3c_device_id *id_table) | |
| { | |
| struct i3c_device_info devinfo; | |
| const struct i3c_device_id *id; | |
| u16 manuf, part, ext_info; | |
| bool rndpid; | |
| i3c_device_get_info(i3cdev, &devinfo); | |
| manuf = I3C_PID_MANUF_ID(devinfo.pid); | |
| part = I3C_PID_PART_ID(devinfo.pid); | |
| ext_info = I3C_PID_EXTRA_INFO(devinfo.pid); | |
| rndpid = I3C_PID_RND_LOWER_32BITS(devinfo.pid); | |
| for (id = id_table; id->match_flags != 0; id++) { | |
| if ((id->match_flags & I3C_MATCH_DCR) && | |
| id->dcr != devinfo.dcr) | |
| continue; | |
| if ((id->match_flags & I3C_MATCH_MANUF) && | |
| id->manuf_id != manuf) | |
| continue; | |
| if ((id->match_flags & I3C_MATCH_PART) && | |
| (rndpid || id->part_id != part)) | |
| continue; | |
| if ((id->match_flags & I3C_MATCH_EXTRA_INFO) && | |
| (rndpid || id->extra_info != ext_info)) | |
| continue; | |
| return id; | |
| } | |
| return NULL; | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_match_id); | |
| /** | |
| * i3c_device_get_supported_xfer_mode - Returns the supported transfer mode by | |
| * connected master controller. | |
| * @dev: I3C device | |
| * | |
| * Return: a bit mask, which supported transfer mode, bit position is defined at | |
| * enum i3c_hdr_mode | |
| */ | |
| u32 i3c_device_get_supported_xfer_mode(struct i3c_device *dev) | |
| { | |
| return i3c_dev_get_master(dev->desc)->this->info.hdr_cap | BIT(I3C_SDR); | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_device_get_supported_xfer_mode); | |
| /** | |
| * i3c_driver_register_with_owner() - register an I3C device driver | |
| * | |
| * @drv: driver to register | |
| * @owner: module that owns this driver | |
| * | |
| * Register @drv to the core. | |
| * | |
| * Return: 0 in case of success, a negative error core otherwise. | |
| */ | |
| int i3c_driver_register_with_owner(struct i3c_driver *drv, struct module *owner) | |
| { | |
| drv->driver.owner = owner; | |
| drv->driver.bus = &i3c_bus_type; | |
| if (!drv->probe) { | |
| pr_err("Trying to register an i3c driver without probe callback\n"); | |
| return -EINVAL; | |
| } | |
| return driver_register(&drv->driver); | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_driver_register_with_owner); | |
| /** | |
| * i3c_driver_unregister() - unregister an I3C device driver | |
| * | |
| * @drv: driver to unregister | |
| * | |
| * Unregister @drv. | |
| */ | |
| void i3c_driver_unregister(struct i3c_driver *drv) | |
| { | |
| driver_unregister(&drv->driver); | |
| } | |
| EXPORT_SYMBOL_GPL(i3c_driver_unregister); |