// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2025 Intel Corporation. * Copyright (c) 2025 Red Hat, Inc. */ #include #include #include #include #include #include #define I2C_RW_OVERHEAD (sizeof(struct usbio_bulk_packet) + sizeof(struct usbio_i2c_rw)) struct usbio_i2c { struct i2c_adapter adap; struct auxiliary_device *adev; struct usbio_i2c_rw *rwbuf; unsigned long quirks; u32 speed; u16 txbuf_len; u16 rxbuf_len; }; static const struct acpi_device_id usbio_i2c_acpi_hids[] = { { "INTC1008" }, /* MTL */ { "INTC10B3" }, /* ARL */ { "INTC10B6" }, /* LNL */ { "INTC10E3" }, /* PTL */ { } }; static const u32 usbio_i2c_speeds[] = { I2C_MAX_STANDARD_MODE_FREQ, I2C_MAX_FAST_MODE_FREQ, I2C_MAX_FAST_MODE_PLUS_FREQ, I2C_MAX_HIGH_SPEED_MODE_FREQ }; static void usbio_i2c_uninit(struct i2c_adapter *adap, struct i2c_msg *msg) { struct usbio_i2c *i2c = i2c_get_adapdata(adap); struct usbio_i2c_uninit ubuf; ubuf.busid = i2c->adev->id; ubuf.config = cpu_to_le16(msg->addr); usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_UNINIT, true, &ubuf, sizeof(ubuf), NULL, 0); } static int usbio_i2c_init(struct i2c_adapter *adap, struct i2c_msg *msg) { struct usbio_i2c *i2c = i2c_get_adapdata(adap); struct usbio_i2c_init ibuf; void *reply_buf; u16 reply_len; int ret; ibuf.busid = i2c->adev->id; ibuf.config = cpu_to_le16(msg->addr); ibuf.speed = cpu_to_le32(i2c->speed); if (i2c->quirks & USBIO_QUIRK_I2C_NO_INIT_ACK) { reply_buf = NULL; reply_len = 0; } else { reply_buf = &ibuf; reply_len = sizeof(ibuf); } ret = usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_INIT, true, &ibuf, sizeof(ibuf), reply_buf, reply_len); if (ret != sizeof(ibuf)) return (ret < 0) ? ret : -EIO; return 0; } static int usbio_i2c_read(struct i2c_adapter *adap, struct i2c_msg *msg) { struct usbio_i2c *i2c = i2c_get_adapdata(adap); u16 rxchunk = i2c->rxbuf_len - I2C_RW_OVERHEAD; struct usbio_i2c_rw *rbuf = i2c->rwbuf; int ret; rbuf->busid = i2c->adev->id; rbuf->config = cpu_to_le16(msg->addr); rbuf->size = cpu_to_le16(msg->len); if (msg->len > rxchunk) { /* Need to split the input buffer */ u16 len = 0; do { if (msg->len - len < rxchunk) rxchunk = msg->len - len; ret = usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_READ, true, rbuf, len == 0 ? sizeof(*rbuf) : 0, rbuf, sizeof(*rbuf) + rxchunk); if (ret < 0) return ret; memcpy(&msg->buf[len], rbuf->data, rxchunk); len += rxchunk; } while (msg->len > len); return 0; } ret = usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_READ, true, rbuf, sizeof(*rbuf), rbuf, sizeof(*rbuf) + msg->len); if (ret != sizeof(*rbuf) + msg->len) return (ret < 0) ? ret : -EIO; memcpy(msg->buf, rbuf->data, msg->len); return 0; } static int usbio_i2c_write(struct i2c_adapter *adap, struct i2c_msg *msg) { struct usbio_i2c *i2c = i2c_get_adapdata(adap); u16 txchunk = i2c->txbuf_len - I2C_RW_OVERHEAD; struct usbio_i2c_rw *wbuf = i2c->rwbuf; int ret; if (msg->len > txchunk) { /* Need to split the output buffer */ u16 len = 0; do { wbuf->busid = i2c->adev->id; wbuf->config = cpu_to_le16(msg->addr); if (i2c->quirks & USBIO_QUIRK_I2C_USE_CHUNK_LEN) wbuf->size = cpu_to_le16(txchunk); else wbuf->size = cpu_to_le16(msg->len); memcpy(wbuf->data, &msg->buf[len], txchunk); len += txchunk; ret = usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_WRITE, msg->len == len, wbuf, sizeof(*wbuf) + txchunk, wbuf, sizeof(*wbuf)); if (ret < 0) return ret; if (msg->len - len < txchunk) txchunk = msg->len - len; } while (msg->len > len); return 0; } wbuf->busid = i2c->adev->id; wbuf->config = cpu_to_le16(msg->addr); wbuf->size = cpu_to_le16(msg->len); memcpy(wbuf->data, msg->buf, msg->len); ret = usbio_bulk_msg(i2c->adev, USBIO_PKTTYPE_I2C, USBIO_I2CCMD_WRITE, true, wbuf, sizeof(*wbuf) + msg->len, wbuf, sizeof(*wbuf)); if (ret != sizeof(*wbuf) || le16_to_cpu(wbuf->size) != msg->len) return (ret < 0) ? ret : -EIO; return 0; } static int usbio_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) { struct usbio_i2c *i2c = i2c_get_adapdata(adap); int ret; usbio_acquire(i2c->adev); ret = usbio_i2c_init(adap, msgs); if (ret) goto out_release; for (int i = 0; i < num; ret = ++i) { if (msgs[i].flags & I2C_M_RD) ret = usbio_i2c_read(adap, &msgs[i]); else ret = usbio_i2c_write(adap, &msgs[i]); if (ret) break; } usbio_i2c_uninit(adap, msgs); out_release: usbio_release(i2c->adev); return ret; } static u32 usbio_i2c_func(struct i2c_adapter *adap) { return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; } static const struct i2c_adapter_quirks usbio_i2c_quirks = { .flags = I2C_AQ_NO_ZERO_LEN | I2C_AQ_NO_REP_START, .max_read_len = SZ_4K, .max_write_len = SZ_4K, }; static const struct i2c_adapter_quirks usbio_i2c_quirks_max_rw_len52 = { .flags = I2C_AQ_NO_ZERO_LEN | I2C_AQ_NO_REP_START, .max_read_len = 52, .max_write_len = 52, }; static const struct i2c_algorithm usbio_i2c_algo = { .master_xfer = usbio_i2c_xfer, .functionality = usbio_i2c_func, }; static int usbio_i2c_probe(struct auxiliary_device *adev, const struct auxiliary_device_id *adev_id) { struct usbio_i2c_bus_desc *i2c_desc; struct device *dev = &adev->dev; struct usbio_i2c *i2c; u32 max_speed; int ret; i2c_desc = dev_get_platdata(dev); if (!i2c_desc) return -EINVAL; i2c = devm_kzalloc(dev, sizeof(*i2c), GFP_KERNEL); if (!i2c) return -ENOMEM; i2c->adev = adev; usbio_acpi_bind(i2c->adev, usbio_i2c_acpi_hids); usbio_get_txrxbuf_len(i2c->adev, &i2c->txbuf_len, &i2c->rxbuf_len); i2c->rwbuf = devm_kzalloc(dev, max(i2c->txbuf_len, i2c->rxbuf_len), GFP_KERNEL); if (!i2c->rwbuf) return -ENOMEM; i2c->quirks = usbio_get_quirks(i2c->adev); max_speed = usbio_i2c_speeds[i2c_desc->caps & USBIO_I2C_BUS_MODE_CAP_MASK]; if (max_speed < I2C_MAX_FAST_MODE_FREQ && (i2c->quirks & USBIO_QUIRK_I2C_ALLOW_400KHZ)) max_speed = I2C_MAX_FAST_MODE_FREQ; i2c->speed = i2c_acpi_find_bus_speed(dev); if (!i2c->speed) i2c->speed = I2C_MAX_STANDARD_MODE_FREQ; else if (i2c->speed > max_speed) { dev_warn(dev, "Invalid speed %u adjusting to bus max %u\n", i2c->speed, max_speed); i2c->speed = max_speed; } i2c->adap.owner = THIS_MODULE; i2c->adap.class = I2C_CLASS_HWMON; i2c->adap.dev.parent = dev; i2c->adap.algo = &usbio_i2c_algo; if (i2c->quirks & USBIO_QUIRK_I2C_MAX_RW_LEN_52) i2c->adap.quirks = &usbio_i2c_quirks_max_rw_len52; else i2c->adap.quirks = &usbio_i2c_quirks; snprintf(i2c->adap.name, sizeof(i2c->adap.name), "%s.%d", USBIO_I2C_CLIENT, i2c->adev->id); device_set_node(&i2c->adap.dev, dev_fwnode(&adev->dev)); auxiliary_set_drvdata(adev, i2c); i2c_set_adapdata(&i2c->adap, i2c); ret = i2c_add_adapter(&i2c->adap); if (ret) return ret; if (has_acpi_companion(&i2c->adap.dev)) acpi_dev_clear_dependencies(ACPI_COMPANION(&i2c->adap.dev)); return 0; } static void usbio_i2c_remove(struct auxiliary_device *adev) { struct usbio_i2c *i2c = auxiliary_get_drvdata(adev); i2c_del_adapter(&i2c->adap); } static const struct auxiliary_device_id usbio_i2c_id_table[] = { { "usbio.usbio-i2c" }, { } }; MODULE_DEVICE_TABLE(auxiliary, usbio_i2c_id_table); static struct auxiliary_driver usbio_i2c_driver = { .name = USBIO_I2C_CLIENT, .probe = usbio_i2c_probe, .remove = usbio_i2c_remove, .id_table = usbio_i2c_id_table }; module_auxiliary_driver(usbio_i2c_driver); MODULE_DESCRIPTION("Intel USBIO I2C driver"); MODULE_AUTHOR("Israel Cepeda "); MODULE_AUTHOR("Hans de Goede "); MODULE_LICENSE("GPL"); MODULE_IMPORT_NS("USBIO");