blob: 5a0455e1195a6b0cb452600abec3f9aaf6f434b8 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Łukasz Majewskie542b7f2011-10-06 02:37:34 +00002/*
3 * Copyright (C) 2011 Samsung Electronics
4 * Lukasz Majewski <l.majewski@samsung.com>
5 *
6 * (C) Copyright 2010
7 * Stefano Babic, DENX Software Engineering, sbabic@denx.de
8 *
9 * (C) Copyright 2008-2009 Freescale Semiconductor, Inc.
Biwen Libb1165f2020-02-05 22:02:17 +080010 * (C) Copyright 2019 NXP
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000011 */
12
13#include <common.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060014#include <log.h>
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000015#include <linux/types.h>
Łukasz Majewskic7336812012-11-13 03:21:55 +000016#include <power/pmic.h>
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000017#include <i2c.h>
Masahiro Yamadaafc366f2014-11-26 16:00:58 +090018#include <linux/compiler.h>
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000019
20int pmic_reg_write(struct pmic *p, u32 reg, u32 val)
21{
22 unsigned char buf[4] = { 0 };
23
Łukasz Majewskic7336812012-11-13 03:21:55 +000024 if (check_reg(p, reg))
Jaehoon Chung505cf472016-12-15 20:49:50 +090025 return -EINVAL;
Biwen Libb1165f2020-02-05 22:02:17 +080026#if defined(CONFIG_DM_I2C)
27 struct udevice *dev;
28 int ret;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000029
Biwen Libb1165f2020-02-05 22:02:17 +080030 ret = i2c_get_chip_for_busnum(p->bus, pmic_i2c_addr,
31 1, &dev);
32 if (ret) {
33 printf("%s: Cannot find udev for a bus %d\n", __func__,
34 p->bus);
35 return -ENXIO;
36 }
37#else /* Non DM I2C support - will be removed */
Aaron Durbin0b259dc2014-05-20 06:01:38 -060038 I2C_SET_BUS(p->bus);
Biwen Libb1165f2020-02-05 22:02:17 +080039#endif
Aaron Durbin0b259dc2014-05-20 06:01:38 -060040
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000041 switch (pmic_i2c_tx_num) {
42 case 3:
Łukasz Majewski86879d72012-11-13 03:21:53 +000043 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
44 buf[2] = (cpu_to_le32(val) >> 16) & 0xff;
45 buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
46 buf[0] = cpu_to_le32(val) & 0xff;
47 } else {
48 buf[0] = (cpu_to_le32(val) >> 16) & 0xff;
49 buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
50 buf[2] = cpu_to_le32(val) & 0xff;
51 }
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000052 break;
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000053 case 2:
Łukasz Majewski86879d72012-11-13 03:21:53 +000054 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG) {
55 buf[1] = (cpu_to_le32(val) >> 8) & 0xff;
56 buf[0] = cpu_to_le32(val) & 0xff;
57 } else {
58 buf[0] = (cpu_to_le32(val) >> 8) & 0xff;
59 buf[1] = cpu_to_le32(val) & 0xff;
60 }
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +000061 break;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000062 case 1:
Łukasz Majewski86879d72012-11-13 03:21:53 +000063 buf[0] = cpu_to_le32(val) & 0xff;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000064 break;
Fabio Estevama22429d2012-03-16 11:32:09 +000065 default:
66 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
Jaehoon Chung505cf472016-12-15 20:49:50 +090067 return -EINVAL;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000068 }
69
Biwen Libb1165f2020-02-05 22:02:17 +080070#if defined(CONFIG_DM_I2C)
71 return dm_i2c_write(dev, reg, buf, pmic_i2c_tx_num);
72#else
Jaehoon Chung505cf472016-12-15 20:49:50 +090073 return i2c_write(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num);
Biwen Libb1165f2020-02-05 22:02:17 +080074#endif
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000075}
76
77int pmic_reg_read(struct pmic *p, u32 reg, u32 *val)
78{
79 unsigned char buf[4] = { 0 };
80 u32 ret_val = 0;
Jaehoon Chung505cf472016-12-15 20:49:50 +090081 int ret;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000082
Łukasz Majewskic7336812012-11-13 03:21:55 +000083 if (check_reg(p, reg))
Jaehoon Chung505cf472016-12-15 20:49:50 +090084 return -EINVAL;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +000085
Biwen Libb1165f2020-02-05 22:02:17 +080086#if defined(CONFIG_DM_I2C)
87 struct udevice *dev;
Aaron Durbin0b259dc2014-05-20 06:01:38 -060088
Biwen Libb1165f2020-02-05 22:02:17 +080089 ret = i2c_get_chip_for_busnum(p->bus, pmic_i2c_addr,
90 1, &dev);
91 if (ret) {
92 printf("%s: Cannot find udev for a bus %d\n", __func__,
93 p->bus);
94 return -ENXIO;
95 }
96 ret = dm_i2c_read(dev, reg, buf, pmic_i2c_tx_num);
97#else /* Non DM I2C support - will be removed */
98 I2C_SET_BUS(p->bus);
Jaehoon Chung505cf472016-12-15 20:49:50 +090099 ret = i2c_read(pmic_i2c_addr, reg, 1, buf, pmic_i2c_tx_num);
Biwen Libb1165f2020-02-05 22:02:17 +0800100#endif
Jaehoon Chung505cf472016-12-15 20:49:50 +0900101 if (ret)
102 return ret;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000103
104 switch (pmic_i2c_tx_num) {
105 case 3:
Łukasz Majewski86879d72012-11-13 03:21:53 +0000106 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
107 ret_val = le32_to_cpu(buf[2] << 16
108 | buf[1] << 8 | buf[0]);
109 else
110 ret_val = le32_to_cpu(buf[0] << 16 |
111 buf[1] << 8 | buf[2]);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000112 break;
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +0000113 case 2:
Łukasz Majewski86879d72012-11-13 03:21:53 +0000114 if (p->sensor_byte_order == PMIC_SENSOR_BYTE_ORDER_BIG)
115 ret_val = le32_to_cpu(buf[1] << 8 | buf[0]);
116 else
117 ret_val = le32_to_cpu(buf[0] << 8 | buf[1]);
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +0000118 break;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000119 case 1:
Łukasz Majewski86879d72012-11-13 03:21:53 +0000120 ret_val = le32_to_cpu(buf[0]);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000121 break;
Fabio Estevama22429d2012-03-16 11:32:09 +0000122 default:
123 printf("%s: invalid tx_num: %d", __func__, pmic_i2c_tx_num);
Jaehoon Chung505cf472016-12-15 20:49:50 +0900124 return -EINVAL;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000125 }
126 memcpy(val, &ret_val, sizeof(ret_val));
127
128 return 0;
129}
130
131int pmic_probe(struct pmic *p)
132{
Łukasz Majewskib5bf9ca2012-11-13 03:21:52 +0000133 debug("Bus: %d PMIC:%s probed!\n", p->bus, p->name);
Biwen Libb1165f2020-02-05 22:02:17 +0800134#if defined(CONFIG_DM_I2C)
135 struct udevice *dev;
136 int ret;
137
138 ret = i2c_get_chip_for_busnum(p->bus, pmic_i2c_addr,
139 1, &dev);
140 if (ret) {
141 printf("%s: Cannot find udev for a bus %d\n", __func__,
142 p->bus);
143 return -ENXIO;
144 }
145#else /* Non DM I2C support - will be removed */
146 i2c_set_bus_num(p->bus);
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000147 if (i2c_probe(pmic_i2c_addr)) {
148 printf("Can't find PMIC:%s\n", p->name);
Jaehoon Chung505cf472016-12-15 20:49:50 +0900149 return -ENODEV;
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000150 }
Biwen Libb1165f2020-02-05 22:02:17 +0800151#endif
Łukasz Majewskie542b7f2011-10-06 02:37:34 +0000152
153 return 0;
154}