pmic:i2c: Handle PMIC I2C transmission comprising of two bytes

This patch adds support for proper handling of a PMIC I2C transmission
comprising of two bytes.

Signed-off-by: Lukasz Majewski <l.majewski@samsung.com>
Signed-off-by: Kyungmin Park <kyungmin.park@samsung.com>
Cc: Stefano Babic <sbabic@denx.de>

diff --git a/drivers/misc/pmic_i2c.c b/drivers/misc/pmic_i2c.c
index 95a3365b9fc72a481ded1937d4293b1fb6cb4042..e74c3727cdc1b93c6b7902d5e1ca648a816188c1 100644 (file)
--- a/drivers/misc/pmic_i2c.c
+++ b/drivers/misc/pmic_i2c.c
@@ -44,6 +44,10 @@ int pmic_reg_write(struct pmic *p, u32 reg, u32 val)
                buf[1] = (val >> 8) & 0xff;
                buf[2] = val & 0xff;
                break;
+       case 2:
+               buf[0] = (val >> 8) & 0xff;
+               buf[1] = val & 0xff;
+               break;
        case 1:
                buf[0] = val & 0xff;
                break;
@@ -73,6 +77,9 @@ int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
        case 3:
                ret_val = buf[0] << 16 | buf[1] << 8 | buf[2];
                break;
+       case 2:
+               ret_val = buf[0] << 8 | buf[1];
+               break;
        case 1:
                ret_val = buf[0];
                break;
@@ -88,7 +95,7 @@ int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
 int pmic_probe(struct pmic *p)
 {
        I2C_SET_BUS(p->bus);
-       debug("PMIC:%s probed!\n", p->name);
+       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;