| /* |
| * Copyright (c) 2014 Google, Inc |
| * |
| * SPDX-License-Identifier: GPL-2.0+ |
| */ |
| |
| #include <common.h> |
| #include <dm.h> |
| #include <errno.h> |
| #include <i2c.h> |
| |
| static int cur_busnum __attribute__((section(".data"))); |
| |
| static int i2c_compat_get_device(uint chip_addr, int alen, |
| struct udevice **devp) |
| { |
| struct dm_i2c_chip *chip; |
| int ret; |
| |
| ret = i2c_get_chip_for_busnum(cur_busnum, chip_addr, alen, devp); |
| if (ret) |
| return ret; |
| chip = dev_get_parent_platdata(*devp); |
| if (chip->offset_len != alen) { |
| printf("I2C chip %x: requested alen %d does not match chip offset_len %d\n", |
| chip_addr, alen, chip->offset_len); |
| return -EADDRNOTAVAIL; |
| } |
| |
| return 0; |
| } |
| |
| int i2c_probe(uint8_t chip_addr) |
| { |
| struct udevice *bus, *dev; |
| int ret; |
| |
| ret = uclass_get_device_by_seq(UCLASS_I2C, cur_busnum, &bus); |
| if (ret) { |
| debug("Cannot find I2C bus %d: err=%d\n", cur_busnum, ret); |
| return ret; |
| } |
| |
| if (!bus) |
| return -ENOENT; |
| |
| return dm_i2c_probe(bus, chip_addr, 0, &dev); |
| } |
| |
| int i2c_read(uint8_t chip_addr, unsigned int addr, int alen, uint8_t *buffer, |
| int len) |
| { |
| struct udevice *dev; |
| int ret; |
| |
| ret = i2c_compat_get_device(chip_addr, alen, &dev); |
| if (ret) |
| return ret; |
| |
| return dm_i2c_read(dev, addr, buffer, len); |
| } |
| |
| int i2c_write(uint8_t chip_addr, unsigned int addr, int alen, uint8_t *buffer, |
| int len) |
| { |
| struct udevice *dev; |
| int ret; |
| |
| ret = i2c_compat_get_device(chip_addr, alen, &dev); |
| if (ret) |
| return ret; |
| |
| return dm_i2c_write(dev, addr, buffer, len); |
| } |
| |
| int i2c_get_bus_num_fdt(int node) |
| { |
| struct udevice *bus; |
| int ret; |
| |
| ret = uclass_get_device_by_of_offset(UCLASS_I2C, node, &bus); |
| if (ret) |
| return ret; |
| |
| return bus->seq; |
| } |
| |
| unsigned int i2c_get_bus_num(void) |
| { |
| return cur_busnum; |
| } |
| |
| int i2c_set_bus_num(unsigned int bus) |
| { |
| cur_busnum = bus; |
| |
| return 0; |
| } |
| |
| void i2c_init(int speed, int slaveaddr) |
| { |
| /* Nothing to do here - the init happens through driver model */ |
| } |
| |
| void board_i2c_init(const void *blob) |
| { |
| /* Nothing to do here - the init happens through driver model */ |
| } |
| |
| uint8_t i2c_reg_read(uint8_t chip_addr, uint8_t offset) |
| { |
| struct udevice *dev; |
| int ret; |
| |
| ret = i2c_compat_get_device(chip_addr, 1, &dev); |
| if (ret) |
| return 0xff; |
| return dm_i2c_reg_read(dev, offset); |
| } |
| |
| void i2c_reg_write(uint8_t chip_addr, uint8_t offset, uint8_t val) |
| { |
| struct udevice *dev; |
| int ret; |
| |
| ret = i2c_compat_get_device(chip_addr, 1, &dev); |
| if (!ret) |
| dm_i2c_reg_write(dev, offset, val); |
| } |