src/device/i2c.c

   1 /* SPDX-License-Identifier: GPL-2.0-only */
   2 /* This file is part of the coreboot project. */
   3
   4 #include <device/i2c_simple.h>
   5 #include <stdint.h>
   6
   7 int i2c_read_field(unsigned int bus, uint8_t chip, uint8_t reg, uint8_t *data,
   8                    uint8_t mask, uint8_t shift)
   9 {
  10         int ret;
  11         uint8_t buf = 0;
  12
  13         ret = i2c_readb(bus, chip, reg, &buf);
  14
  15         buf &= (mask << shift);
  16         *data = (buf >> shift);
  17
  18         return ret;
  19 }
  20
  21 int i2c_write_field(unsigned int bus, uint8_t chip, uint8_t reg, uint8_t data,
  22                     uint8_t mask, uint8_t shift)
  23 {
  24         int ret;
  25         uint8_t buf = 0;
  26
  27         ret = i2c_readb(bus, chip, reg, &buf);
  28
  29         buf &= ~(mask << shift);
  30         buf |= (data << shift);
  31
  32         ret |= i2c_writeb(bus, chip, reg, buf);
  33
  34         return ret;
  35 }