1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * (C) Copyright 2017 4 * Texas Instruments Incorporated, <www.ti.com> 5 * 6 * Keerthy <j-keerthy@ti.com> 7 */ 8 9#include <common.h> 10#include <fdtdec.h> 11#include <errno.h> 12#include <dm.h> 13#include <log.h> 14#include <power/pmic.h> 15#include <power/regulator.h> 16#include <power/lp87565.h> 17 18static const char lp87565_buck_ctrl1[LP87565_BUCK_NUM] = {0x2, 0x4, 0x6, 0x8, 0x2, 0x6}; 19static const char lp87565_buck_vout[LP87565_BUCK_NUM] = {0xA, 0xC, 0xE, 0x10, 0xA, 0xE }; 20 21static int lp87565_buck_enable(struct udevice *dev, int op, bool *enable) 22{ 23 int ret; 24 unsigned int adr; 25 struct dm_regulator_uclass_plat *uc_pdata; 26 27 uc_pdata = dev_get_uclass_plat(dev); 28 adr = uc_pdata->ctrl_reg; 29 30 ret = pmic_reg_read(dev->parent, adr); 31 if (ret < 0) 32 return ret; 33 34 if (op == PMIC_OP_GET) { 35 ret &= LP87565_BUCK_MODE_MASK; 36 37 if (ret) 38 *enable = true; 39 else 40 *enable = false; 41 42 return 0; 43 } else if (op == PMIC_OP_SET) { 44 if (*enable) 45 ret |= LP87565_BUCK_MODE_MASK; 46 else 47 ret &= ~LP87565_BUCK_MODE_MASK; 48 ret = pmic_reg_write(dev->parent, adr, ret); 49 if (ret) 50 return ret; 51 } 52 53 return 0; 54} 55 56static int lp87565_buck_volt2val(int uV) 57{ 58 if (uV > LP87565_BUCK_VOLT_MAX) 59 return -EINVAL; 60 else if (uV > 1400000) 61 return (uV - 1420000) / 20000 + 0x9E; 62 else if (uV > 730000) 63 return (uV - 735000) / 5000 + 0x18; 64 else if (uV >= 500000) 65 return (uV - 500000) / 10000; 66 else 67 return -EINVAL; 68} 69 70static int lp87565_buck_val2volt(int val) 71{ 72 if (val > LP87565_BUCK_VOLT_MAX_HEX) 73 return -EINVAL; 74 else if (val > 0x9D) 75 return 1400000 + (val - 0x9D) * 20000; 76 else if (val > 0x17) 77 return 730000 + (val - 0x17) * 5000; 78 else if (val >= 0x0) 79 return 500000 + val * 10000; 80 else 81 return -EINVAL; 82} 83 84static int lp87565_buck_val(struct udevice *dev, int op, int *uV) 85{ 86 unsigned int hex, adr; 87 int ret; 88 struct dm_regulator_uclass_plat *uc_pdata; 89 90 uc_pdata = dev_get_uclass_plat(dev); 91 92 if (op == PMIC_OP_GET) 93 *uV = 0; 94 95 adr = uc_pdata->volt_reg; 96 97 ret = pmic_reg_read(dev->parent, adr); 98 if (ret < 0) 99 return ret; 100 101 if (op == PMIC_OP_GET) { 102 ret &= LP87565_BUCK_VOLT_MASK; 103 ret = lp87565_buck_val2volt(ret); 104 if (ret < 0) 105 return ret; 106 *uV = ret; 107 108 return 0; 109 } 110 111 hex = lp87565_buck_volt2val(*uV); 112 if (hex < 0) 113 return hex; 114 115 ret &= 0x0; 116 ret = hex; 117 118 ret = pmic_reg_write(dev->parent, adr, ret); 119 120 return ret; 121} 122 123static int lp87565_buck_probe(struct udevice *dev) 124{ 125 struct dm_regulator_uclass_plat *uc_pdata; 126 int idx; 127 128 uc_pdata = dev_get_uclass_plat(dev); 129 uc_pdata->type = REGULATOR_TYPE_BUCK; 130 131 idx = dev->driver_data; 132 if (idx == 0 || idx == 1 || idx == 2 || idx == 3) { 133 debug("Single phase regulator\n"); 134 } else if (idx == 23) { 135 idx = 5; 136 } else if (idx == 10) { 137 idx = 4; 138 } else { 139 printf("Wrong ID for regulator\n"); 140 return -EINVAL; 141 } 142 143 uc_pdata->ctrl_reg = lp87565_buck_ctrl1[idx]; 144 uc_pdata->volt_reg = lp87565_buck_vout[idx]; 145 146 return 0; 147} 148 149static int buck_get_value(struct udevice *dev) 150{ 151 int uV; 152 int ret; 153 154 ret = lp87565_buck_val(dev, PMIC_OP_GET, &uV); 155 if (ret) 156 return ret; 157 158 return uV; 159} 160 161static int buck_set_value(struct udevice *dev, int uV) 162{ 163 return lp87565_buck_val(dev, PMIC_OP_SET, &uV); 164} 165 166static int buck_get_enable(struct udevice *dev) 167{ 168 bool enable = false; 169 int ret; 170 171 172 ret = lp87565_buck_enable(dev, PMIC_OP_GET, &enable); 173 if (ret) 174 return ret; 175 176 return enable; 177} 178 179static int buck_set_enable(struct udevice *dev, bool enable) 180{ 181 return lp87565_buck_enable(dev, PMIC_OP_SET, &enable); 182} 183 184static const struct dm_regulator_ops lp87565_buck_ops = { 185 .get_value = buck_get_value, 186 .set_value = buck_set_value, 187 .get_enable = buck_get_enable, 188 .set_enable = buck_set_enable, 189}; 190 191U_BOOT_DRIVER(lp87565_buck) = { 192 .name = LP87565_BUCK_DRIVER, 193 .id = UCLASS_REGULATOR, 194 .ops = &lp87565_buck_ops, 195 .probe = lp87565_buck_probe, 196}; 197