blob: ac768708eadf22aacc4f2e6e15c66d07a5c248f5 [file] [log] [blame]
Łukasz Majewskie542b7f2011-10-06 02:37:34 +00001/*
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 *
Wolfgang Denk1a459662013-07-08 09:37:19 +020010 * SPDX-License-Identifier: GPL-2.0+
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000011 */
12
13#include <common.h>
14#include <linux/types.h>
Łukasz Majewskic7336812012-11-13 03:21:55 +000015#include <power/pmic.h>
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000016#include <i2c.h>
Łukasz Majewski86879d72012-11-13 03:21:53 +000017#include <compiler.h>
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000018
19int pmic_reg_write(struct pmic *p, u32 reg, u32 val)
20{
21 unsigned char buf[4] = { 0 };
22
Łukasz Majewskic7336812012-11-13 03:21:55 +000023 if (check_reg(p, reg))
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000024 return -1;
25
26 switch (pmic_i2c_tx_num) {
27 case 3:
Łukasz Majewski86879d72012-11-13 03:21:53 +000028 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 }
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000037 break;
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000038 case 2:
Łukasz Majewski86879d72012-11-13 03:21:53 +000039 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 }
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000046 break;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000047 case 1:
Łukasz Majewski86879d72012-11-13 03:21:53 +000048 buf[0] = cpu_to_le32(val) & 0xff;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000049 break;
Fabio Estevama22429d2012-03-16 11:32:09 +000050 default:
51 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
52 return -1;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000053 }
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
Łukasz Majewskic7336812012-11-13 03:21:55 +000066 if (check_reg(p, reg))
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000067 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:
Łukasz Majewski86879d72012-11-13 03:21:53 +000074 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]);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000080 break;
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000081 case 2:
Łukasz Majewski86879d72012-11-13 03:21:53 +000082 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]);
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000086 break;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000087 case 1:
Łukasz Majewski86879d72012-11-13 03:21:53 +000088 ret_val = le32_to_cpu(buf[0]);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000089 break;
Fabio Estevama22429d2012-03-16 11:32:09 +000090 default:
91 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
92 return -1;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000093 }
94 memcpy(val, &ret_val, sizeof(ret_val));
95
96 return 0;
97}
98
99int pmic_probe(struct pmic *p)
100{
Łukasz Majewski3fbb5172013-08-16 15:35:26 +0200101 i2c_set_bus_num(p->bus);
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +0000102 debug("Bus: %d PMIC:%s probed!\n", p->bus, p->name);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000103 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}