/* SPDX-License-Identifier: GPL-2.0-only */ #include <commonlib/bsd/helpers.h> #include <console/console.h> #include <device/device.h> #include <device/smbus.h> #include <device/i2c_bus.h> #include <commonlib/endian.h> #include <types.h> bool i2c_dev_detect(struct device *dev, unsigned int addr) { struct i2c_msg seg = { .flags = 0, .slave = addr, .buf = NULL, .len = 0 }; if (!dev) return false; return dev->ops->ops_i2c_bus->transfer(dev, &seg, 1) == 0; } struct bus *i2c_link(const struct device *const dev) { if (!dev || !dev->upstream) return NULL; struct bus *link = dev->upstream; while (link) { struct device *const parent = link->dev; if (parent && parent->ops && (parent->ops->ops_i2c_bus || parent->ops->ops_smbus_bus)) break; if (parent && parent->upstream && link != parent->upstream) link = parent->upstream; else link = NULL; } if (!link) printk(BIOS_ALERT, "%s Cannot find I2C or SMBus bus operations\n", dev_path(dev)); return link; } int i2c_dev_readb(struct device *const dev) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { uint8_t val; const struct i2c_msg msg = { .flags = I2C_M_RD, .slave = dev->path.i2c.device, .buf = &val, .len = sizeof(val), }; const int ret = busdev->ops->ops_i2c_bus->transfer(busdev, &msg, 1); if (ret) return ret; else return val; } else if (busdev->ops->ops_smbus_bus->recv_byte) { return busdev->ops->ops_smbus_bus->recv_byte(dev); } printk(BIOS_ERR, "%s Missing ops_smbus_bus->recv_byte", dev_path(busdev)); return -1; } int i2c_dev_writeb(struct device *const dev, uint8_t val) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { const struct i2c_msg msg = { .flags = 0, .slave = dev->path.i2c.device, .buf = &val, .len = sizeof(val), }; return busdev->ops->ops_i2c_bus->transfer(busdev, &msg, 1); } else if (busdev->ops->ops_smbus_bus->send_byte) { return busdev->ops->ops_smbus_bus->send_byte(dev, val); } printk(BIOS_ERR, "%s Missing ops_smbus_bus->send_byte", dev_path(busdev)); return -1; } int i2c_dev_readb_at(struct device *const dev, uint8_t off) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { uint8_t val; const struct i2c_msg msg[] = { { .flags = 0, .slave = dev->path.i2c.device, .buf = &off, .len = sizeof(off), }, { .flags = I2C_M_RD, .slave = dev->path.i2c.device, .buf = &val, .len = sizeof(val), }, }; const int ret = busdev->ops->ops_i2c_bus->transfer(busdev, msg, ARRAY_SIZE(msg)); if (ret) return ret; else return val; } else if (busdev->ops->ops_smbus_bus->read_byte) { return busdev->ops->ops_smbus_bus->read_byte(dev, off); } printk(BIOS_ERR, "%s Missing ops_smbus_bus->read_byte", dev_path(busdev)); return -1; } int i2c_dev_writeb_at(struct device *const dev, const uint8_t off, const uint8_t val) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { uint8_t buf[] = { off, val }; const struct i2c_msg msg = { .flags = 0, .slave = dev->path.i2c.device, .buf = buf, .len = sizeof(buf), }; return busdev->ops->ops_i2c_bus->transfer(busdev, &msg, 1); } else if (busdev->ops->ops_smbus_bus->write_byte) { return busdev->ops->ops_smbus_bus->write_byte(dev, off, val); } printk(BIOS_ERR, "%s Missing ops_smbus_bus->write_byte", dev_path(busdev)); return -1; } int i2c_dev_read_at16(struct device *const dev, uint8_t *const buf, const size_t len, uint16_t off) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { const struct i2c_msg msg[] = { { .flags = 0, .slave = dev->path.i2c.device, .buf = (uint8_t *)&off, .len = sizeof(off), }, { .flags = I2C_M_RD, .slave = dev->path.i2c.device, .buf = buf, .len = len, }, }; write_be16(&off, off); const int ret = busdev->ops->ops_i2c_bus->transfer(busdev, msg, ARRAY_SIZE(msg)); if (ret) return ret; else return len; } else { printk(BIOS_ERR, "%s Missing ops_i2c_bus->transfer", dev_path(busdev)); return -1; } } int i2c_dev_read_at(struct device *const dev, uint8_t *const buf, const size_t len, uint8_t off) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { const struct i2c_msg msg[] = { { .flags = 0, .slave = dev->path.i2c.device, .buf = &off, .len = sizeof(off), }, { .flags = I2C_M_RD, .slave = dev->path.i2c.device, .buf = buf, .len = len, }, }; const int ret = busdev->ops->ops_i2c_bus->transfer(busdev, msg, ARRAY_SIZE(msg)); if (ret) return ret; else return len; } else { printk(BIOS_ERR, "%s Missing ops_i2c_bus->transfer", dev_path(busdev)); return -1; } } int i2c_dev_write_at(struct device *const dev, uint8_t *const buf, const size_t len, uint8_t off) { struct device *const busdev = i2c_busdev(dev); if (!busdev) return -1; if (busdev->ops->ops_i2c_bus) { const struct i2c_msg msg[] = { { .flags = 0, .slave = dev->path.i2c.device, .buf = &off, .len = sizeof(off), }, { .flags = I2C_M_NOSTART, .slave = dev->path.i2c.device, .buf = buf, .len = len, }, }; const int ret = busdev->ops->ops_i2c_bus->transfer(busdev, msg, ARRAY_SIZE(msg)); if (ret) return ret; else return len; } else { printk(BIOS_ERR, "%s Missing ops_i2c_bus->transfer", dev_path(busdev)); return -1; } }