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 <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 -1;
  25
  26         switch (pmic_i2c_tx_num) {
  27         case 3:
  28                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
  29                         buf[2] = (cpu_to_le32(val) >> 16) & 0xff;
  30                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  31                         buf[0] = cpu_to_le32(val) & 0xff;
  32                 } else {
  33                         buf[0] = (cpu_to_le32(val) >> 16) & 0xff;
  34                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  35                         buf[2] = cpu_to_le32(val) & 0xff;
  36                 }
  37                 break;
  38         case 2:
  39                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
  40                         buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
  41                         buf[0] = cpu_to_le32(val) & 0xff;
  42                 } else {
  43                         buf[0] = (cpu_to_le32(val) >> 8) & 0xff;
  44                         buf[1] = cpu_to_le32(val) & 0xff;
  45                 }
  46                 break;
  47         case 1:
  48                 buf[0] = cpu_to_le32(val) & 0xff;
  49                 break;
  50         default:
  51                 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
  52                 return -1;
  53         }
  54
  55         if (i2c_write(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num))
  56                 return -1;
  57
  58         return 0;
  59 }
  60
  61 int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
  62 {
  63         unsigned char buf[4] = { 0 };
  64         u32 ret_val = 0;
  65
  66         if (check_reg(p, reg))
  67                 return -1;
  68
  69         if (i2c_read(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num))
  70                 return -1;
  71
  72         switch (pmic_i2c_tx_num) {
  73         case 3:
  74                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
  75                         ret_val = le32_to_cpu(buf[2] << 16
  76                                               | buf[1] << 8 | buf[0]);
  77                 else
  78                         ret_val = le32_to_cpu(buf[0] << 16 |
  79                                               buf[1] << 8 | buf[2]);
  80                 break;
  81         case 2:
  82                 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
  83                         ret_val = le32_to_cpu(buf[1] << 8 | buf[0]);
  84                 else
  85                         ret_val = le32_to_cpu(buf[0] << 8 | buf[1]);
  86                 break;
  87         case 1:
  88                 ret_val = le32_to_cpu(buf[0]);
  89                 break;
  90         default:
  91                 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
  92                 return -1;
  93         }
  94         memcpy(val, &ret_val, sizeof(ret_val));
  95
  96         return 0;
  97 }
  98
  99 int pmic_probe(struct pmic *p)
 100 {
 101         i2c_set_bus_num(p->bus);
 102         debug("Bus: %d PMIC:%s probed!\n", p->bus, p->name);
 103         if (i2c_probe(pmic_i2c_addr)) {
 104                 printf("Can't find PMIC:%s\n", p->name);
 105                 return -1;
 106         }
 107
 108         return 0;
 109 }