1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright (C) 2014-2015 Samsung Electronics 4 * Przemyslaw Marczak <p.marczak@samsung.com> 5 */ 6 7 #include <common.h> 8 #include <fdtdec.h> 9 #include <errno.h> 10 #include <dm.h> 11 #include <vsprintf.h> 12 #include <dm/lists.h> 13 #include <dm/device-internal.h> 14 #include <dm/uclass-internal.h> 15 #include <power/pmic.h> 16 #include <linux/ctype.h> 17 18 #if CONFIG_IS_ENABLED(PMIC_CHILDREN) 19 int pmic_bind_children(struct udevice *pmic, ofnode parent, 20 const struct pmic_child_info *child_info) 21 { 22 const struct pmic_child_info *info; 23 struct driver *drv; 24 struct udevice *child; 25 const char *node_name; 26 const char *reg_name; 27 int bind_count = 0; 28 ofnode node; 29 int prefix_len; 30 int ret; 31 32 debug("%s for '%s' at node offset: %d\n", __func__, pmic->name, 33 dev_of_offset(pmic)); 34 35 ofnode_for_each_subnode(node, parent) { 36 node_name = ofnode_get_name(node); 37 38 debug("* Found child node: '%s'\n", node_name); 39 40 child = NULL; 41 for (info = child_info; info->prefix && info->driver; info++) { 42 debug(" - compatible prefix: '%s'\n", info->prefix); 43 44 prefix_len = strlen(info->prefix); 45 if (strncmp(info->prefix, node_name, prefix_len)) { 46 reg_name = ofnode_read_string(node, 47 "regulator-name"); 48 if (!reg_name) 49 continue; 50 if (strncmp(info->prefix, reg_name, prefix_len)) 51 continue; 52 } 53 54 drv = lists_driver_lookup_name(info->driver); 55 if (!drv) { 56 debug(" - driver: '%s' not found!\n", 57 info->driver); 58 continue; 59 } 60 61 debug(" - found child driver: '%s'\n", drv->name); 62 63 ret = device_bind_with_driver_data(pmic, drv, node_name, 64 0, node, &child); 65 if (ret) { 66 debug(" - child binding error: %d\n", ret); 67 continue; 68 } 69 70 debug(" - bound child device: '%s'\n", child->name); 71 72 child->driver_data = trailing_strtol(node_name); 73 74 debug(" - set 'child->driver_data': %lu\n", 75 child->driver_data); 76 break; 77 } 78 79 if (child) 80 bind_count++; 81 else 82 debug(" - compatible prefix not found\n"); 83 } 84 85 debug("Bound: %d children for PMIC: '%s'\n", bind_count, pmic->name); 86 return bind_count; 87 } 88 #endif 89 90 int pmic_get(const char *name, struct udevice **devp) 91 { 92 return uclass_get_device_by_name(UCLASS_PMIC, name, devp); 93 } 94 95 int pmic_reg_count(struct udevice *dev) 96 { 97 const struct dm_pmic_ops *ops = dev_get_driver_ops(dev); 98 99 if (!ops || !ops->reg_count) 100 return -ENOSYS; 101 102 return ops->reg_count(dev); 103 } 104 105 int pmic_read(struct udevice *dev, uint reg, uint8_t *buffer, int len) 106 { 107 const struct dm_pmic_ops *ops = dev_get_driver_ops(dev); 108 109 if (!buffer) 110 return -EFAULT; 111 112 if (!ops || !ops->read) 113 return -ENOSYS; 114 115 return ops->read(dev, reg, buffer, len); 116 } 117 118 int pmic_write(struct udevice *dev, uint reg, const uint8_t *buffer, int len) 119 { 120 const struct dm_pmic_ops *ops = dev_get_driver_ops(dev); 121 122 if (!buffer) 123 return -EFAULT; 124 125 if (!ops || !ops->write) 126 return -ENOSYS; 127 128 return ops->write(dev, reg, buffer, len); 129 } 130 131 int pmic_reg_read(struct udevice *dev, uint reg) 132 { 133 struct uc_pmic_priv *priv = dev_get_uclass_priv(dev); 134 u32 val = 0; 135 int ret; 136 137 if (priv->trans_len < 1 || priv->trans_len > sizeof(val)) { 138 debug("Wrong transmission size [%d]\n", priv->trans_len); 139 return -EINVAL; 140 } 141 142 debug("%s: reg=%x priv->trans_len:%d", __func__, reg, priv->trans_len); 143 ret = pmic_read(dev, reg, (uint8_t *)&val, priv->trans_len); 144 debug(", value=%x, ret=%d\n", val, ret); 145 146 return ret ? ret : val; 147 } 148 149 int pmic_reg_write(struct udevice *dev, uint reg, uint value) 150 { 151 struct uc_pmic_priv *priv = dev_get_uclass_priv(dev); 152 int ret; 153 154 if (priv->trans_len < 1 || priv->trans_len > sizeof(value)) { 155 debug("Wrong transmission size [%d]\n", priv->trans_len); 156 return -EINVAL; 157 } 158 159 debug("%s: reg=%x, value=%x priv->trans_len:%d", __func__, reg, value, 160 priv->trans_len); 161 ret = pmic_write(dev, reg, (uint8_t *)&value, priv->trans_len); 162 debug(", ret=%d\n", ret); 163 164 return ret; 165 } 166 167 int pmic_clrsetbits(struct udevice *dev, uint reg, uint clr, uint set) 168 { 169 struct uc_pmic_priv *priv = dev_get_uclass_priv(dev); 170 u32 val = 0; 171 int ret; 172 173 if (priv->trans_len < 1 || priv->trans_len > sizeof(val)) { 174 debug("Wrong transmission size [%d]\n", priv->trans_len); 175 return -EINVAL; 176 } 177 178 ret = pmic_read(dev, reg, (uint8_t *)&val, priv->trans_len); 179 if (ret < 0) 180 return ret; 181 182 val = (val & ~clr) | set; 183 return pmic_write(dev, reg, (uint8_t *)&val, priv->trans_len); 184 } 185 186 static int pmic_pre_probe(struct udevice *dev) 187 { 188 struct uc_pmic_priv *pmic_priv = dev_get_uclass_priv(dev); 189 190 pmic_priv->trans_len = 1; 191 return 0; 192 } 193 194 UCLASS_DRIVER(pmic) = { 195 .id = UCLASS_PMIC, 196 .name = "pmic", 197 .pre_probe = pmic_pre_probe, 198 .per_device_auto_alloc_size = sizeof(struct uc_pmic_priv), 199 }; 200