LXR uboot/drivers/power/power

   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
  19int 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
  61int 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
  99int 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}
 110