git.sur5r.net Git - u-boot/blob - drivers/power/power_i2c.c

   1 /*
   2  * Copyright (C) 2011 Samsung Electronics
   3  * Lukasz Majewski <l.majewski@samsung.com>
   4  *
   5  * (C) Copyright 2010
   6  * Stefano Babic, DENX Software Engineering, sbabic@denx.de
   7  *
   8  * (C) Copyright 2008-2009 Freescale Semiconductor, Inc.
   9  *
  10  * SPDX-License-Identifier:     GPL-2.0+
  11  */
  12
  13 #include <common.h>
  14 #include <linux/types.h>
  15 #include <power/pmic.h>
  16 #include <i2c.h>
  17 #include <linux/compiler.h>
  18
  19 int pmic_reg_write(struct pmic *p, u32 reg, u32 val)
  20 {
  21         unsigned char buf[4] = { 0 };
  22
  23         if (check_reg(p, reg))
  24                 return -EINVAL;
  25
  26         I2C_SET_BUS(p->bus);
  27
  28         switch (pmic_i2c_tx_num) {
  29         case 3:
  30                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
  31                         buf[2] = (cpu_to_le32(val) >> 16) & 0xff;
  32                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  33                         buf[0] = cpu_to_le32(val) & 0xff;
  34                 } else {
  35                         buf[0] = (cpu_to_le32(val) >> 16) & 0xff;
  36                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  37                         buf[2] = cpu_to_le32(val) & 0xff;
  38                 }
  39                 break;
  40         case 2:
  41                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
  42                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  43                         buf[0] = cpu_to_le32(val) & 0xff;
  44                 } else {
  45                         buf[0] = (cpu_to_le32(val) >> 8) & 0xff;
  46                         buf[1] = cpu_to_le32(val) & 0xff;
  47                 }
  48                 break;
  49         case 1:
  50                 buf[0] = cpu_to_le32(val) & 0xff;
  51                 break;
  52         default:
  53                 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
  54                 return -EINVAL;
  55         }
  56
  57         return i2c_write(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num);
  58 }
  59
  60 int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
  61 {
  62         unsigned char buf[4] = { 0 };
  63         u32 ret_val = 0;
  64         int ret;
  65
  66         if (check_reg(p, reg))
  67                 return -EINVAL;
  68
  69         I2C_SET_BUS(p->bus);
  70
  71         ret = i2c_read(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num);
  72         if (ret)
  73                 return ret;
  74
  75         switch (pmic_i2c_tx_num) {
  76         case 3:
  77                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
  78                         ret_val = le32_to_cpu(buf[2] << 16
  79                                               | buf[1] << 8 | buf[0]);
  80                 else
  81                         ret_val = le32_to_cpu(buf[0] << 16 |
  82                                               buf[1] << 8 | buf[2]);
  83                 break;
  84         case 2:
  85                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
  86                         ret_val = le32_to_cpu(buf[1] << 8 | buf[0]);
  87                 else
  88                         ret_val = le32_to_cpu(buf[0] << 8 | buf[1]);
  89                 break;
  90         case 1:
  91                 ret_val = le32_to_cpu(buf[0]);
  92                 break;
  93         default:
  94                 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
  95                 return -EINVAL;
  96         }
  97         memcpy(val, &ret_val, sizeof(ret_val));
  98
  99         return 0;
 100 }
 101
 102 int pmic_probe(struct pmic *p)
 103 {
 104         i2c_set_bus_num(p->bus);
 105         debug("Bus: %d PMIC:%s probed!\n", p->bus, p->name);
 106         if (i2c_probe(pmic_i2c_addr)) {
 107                 printf("Can't find PMIC:%s\n", p->name);
 108                 return -ENODEV;
 109         }
 110
 111         return 0;
 112 }