u-boot/drivers/power/power_i2c.c
Aaron Durbin 0b259dc2e8 power: Explicitly select pmic device's bus
The current pmic i2c code assumes the current i2c bus is
the same as the pmic device's bus. There is nothing ensuring
that to be true. Therefore, select the proper bus before performing
a transaction.

Signed-off-by: Aaron Durbin <adurbin@chromium.org>
Signed-off-by: Simon Glass <sjg@chromium.org>
Acked-by: Heiko Schocher <hs@denx.de>
Reviewed-by: Simon Glass <sjg@chromium.org>
Signed-off-by: Minkyu Kang <mk7.kang@samsung.com>
2014-05-28 10:58:19 +09:00

114 lines
2.4 KiB
C

/*
* Copyright (C) 2011 Samsung Electronics
* Lukasz Majewski <l.majewski@samsung.com>
*
* (C) Copyright 2010
* Stefano Babic, DENX Software Engineering, sbabic@denx.de
*
* (C) Copyright 2008-2009 Freescale Semiconductor, Inc.
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <linux/types.h>
#include <power/pmic.h>
#include <i2c.h>
#include <compiler.h>
int pmic_reg_write(struct pmic *p, u32 reg, u32 val)
{
unsigned char buf[4] = { 0 };
if (check_reg(p, reg))
return -1;
I2C_SET_BUS(p->bus);
switch (pmic_i2c_tx_num) {
case 3:
if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
buf[2] = (cpu_to_le32(val) >> 16) & 0xff;
buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
buf[0] = cpu_to_le32(val) & 0xff;
} else {
buf[0] = (cpu_to_le32(val) >> 16) & 0xff;
buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
buf[2] = cpu_to_le32(val) & 0xff;
}
break;
case 2:
if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
buf[0] = cpu_to_le32(val) & 0xff;
} else {
buf[0] = (cpu_to_le32(val) >> 8) & 0xff;
buf[1] = cpu_to_le32(val) & 0xff;
}
break;
case 1:
buf[0] = cpu_to_le32(val) & 0xff;
break;
default:
printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
return -1;
}
if (i2c_write(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num))
return -1;
return 0;
}
int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
{
unsigned char buf[4] = { 0 };
u32 ret_val = 0;
if (check_reg(p, reg))
return -1;
I2C_SET_BUS(p->bus);
if (i2c_read(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num))
return -1;
switch (pmic_i2c_tx_num) {
case 3:
if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
ret_val = le32_to_cpu(buf[2] << 16
| buf[1] << 8 | buf[0]);
else
ret_val = le32_to_cpu(buf[0] << 16 |
buf[1] << 8 | buf[2]);
break;
case 2:
if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
ret_val = le32_to_cpu(buf[1] << 8 | buf[0]);
else
ret_val = le32_to_cpu(buf[0] << 8 | buf[1]);
break;
case 1:
ret_val = le32_to_cpu(buf[0]);
break;
default:
printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
return -1;
}
memcpy(val, &ret_val, sizeof(ret_val));
return 0;
}
int pmic_probe(struct pmic *p)
{
i2c_set_bus_num(p->bus);
debug("Bus: %d PMIC:%s probed!\n", p->bus, p->name);
if (i2c_probe(pmic_i2c_addr)) {
printf("Can't find PMIC:%s\n", p->name);
return -1;
}
return 0;
}