48 lines
1.1 KiB
C
48 lines
1.1 KiB
C
/*
|
|
* This file is part of the coreboot project.
|
|
*
|
|
* Copyright 2016 MediaTek Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <device/i2c_simple.h>
|
|
#include <stdint.h>
|
|
|
|
int i2c_read_field(unsigned bus, uint8_t chip, uint8_t reg, uint8_t *data,
|
|
uint8_t mask, uint8_t shift)
|
|
{
|
|
int ret;
|
|
uint8_t buf = 0;
|
|
|
|
ret = i2c_readb(bus, chip, reg, &buf);
|
|
|
|
buf &= (mask << shift);
|
|
*data = (buf >> shift);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int i2c_write_field(unsigned bus, uint8_t chip, uint8_t reg, uint8_t data,
|
|
uint8_t mask, uint8_t shift)
|
|
{
|
|
int ret;
|
|
uint8_t buf = 0;
|
|
|
|
ret = i2c_readb(bus, chip, reg, &buf);
|
|
|
|
buf &= ~(mask << shift);
|
|
buf |= (data << shift);
|
|
|
|
ret |= i2c_writeb(bus, chip, reg, buf);
|
|
|
|
return ret;
|
|
}
|