| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 1 | /* | 
|  | 2 | * phy-core.c  --  Generic Phy framework. | 
|  | 3 | * | 
|  | 4 | * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com | 
|  | 5 | * | 
|  | 6 | * Author: Kishon Vijay Abraham I <kishon@ti.com> | 
|  | 7 | * | 
|  | 8 | * This program is free software; you can redistribute  it and/or modify it | 
|  | 9 | * under  the terms of  the GNU General  Public License as published by the | 
|  | 10 | * Free Software Foundation;  either version 2 of the  License, or (at your | 
|  | 11 | * option) any later version. | 
|  | 12 | */ | 
|  | 13 |  | 
|  | 14 | #include <linux/kernel.h> | 
|  | 15 | #include <linux/export.h> | 
|  | 16 | #include <linux/module.h> | 
|  | 17 | #include <linux/err.h> | 
|  | 18 | #include <linux/device.h> | 
|  | 19 | #include <linux/slab.h> | 
|  | 20 | #include <linux/of.h> | 
|  | 21 | #include <linux/phy/phy.h> | 
|  | 22 | #include <linux/idr.h> | 
|  | 23 | #include <linux/pm_runtime.h> | 
| Roger Quadros | 3be8812 | 2014-07-04 12:55:45 +0300 | [diff] [blame] | 24 | #include <linux/regulator/consumer.h> | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 25 |  | 
|  | 26 | static struct class *phy_class; | 
|  | 27 | static DEFINE_MUTEX(phy_provider_mutex); | 
|  | 28 | static LIST_HEAD(phy_provider_list); | 
| Heikki Krogerus | b7bc15b | 2014-11-19 17:28:18 +0200 | [diff] [blame] | 29 | static LIST_HEAD(phys); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 30 | static DEFINE_IDA(phy_ida); | 
|  | 31 |  | 
|  | 32 | static void devm_phy_release(struct device *dev, void *res) | 
|  | 33 | { | 
|  | 34 | struct phy *phy = *(struct phy **)res; | 
|  | 35 |  | 
|  | 36 | phy_put(phy); | 
|  | 37 | } | 
|  | 38 |  | 
|  | 39 | static void devm_phy_provider_release(struct device *dev, void *res) | 
|  | 40 | { | 
|  | 41 | struct phy_provider *phy_provider = *(struct phy_provider **)res; | 
|  | 42 |  | 
|  | 43 | of_phy_provider_unregister(phy_provider); | 
|  | 44 | } | 
|  | 45 |  | 
|  | 46 | static void devm_phy_consume(struct device *dev, void *res) | 
|  | 47 | { | 
|  | 48 | struct phy *phy = *(struct phy **)res; | 
|  | 49 |  | 
|  | 50 | phy_destroy(phy); | 
|  | 51 | } | 
|  | 52 |  | 
|  | 53 | static int devm_phy_match(struct device *dev, void *res, void *match_data) | 
|  | 54 | { | 
| Thierry Reding | 2f1bce4 | 2015-02-25 16:16:29 +0100 | [diff] [blame] | 55 | struct phy **phy = res; | 
|  | 56 |  | 
|  | 57 | return *phy == match_data; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 58 | } | 
|  | 59 |  | 
| Heikki Krogerus | b7bc15b | 2014-11-19 17:28:18 +0200 | [diff] [blame] | 60 | /** | 
|  | 61 | * phy_create_lookup() - allocate and register PHY/device association | 
|  | 62 | * @phy: the phy of the association | 
|  | 63 | * @con_id: connection ID string on device | 
|  | 64 | * @dev_id: the device of the association | 
|  | 65 | * | 
|  | 66 | * Creates and registers phy_lookup entry. | 
|  | 67 | */ | 
|  | 68 | int phy_create_lookup(struct phy *phy, const char *con_id, const char *dev_id) | 
|  | 69 | { | 
|  | 70 | struct phy_lookup *pl; | 
|  | 71 |  | 
|  | 72 | if (!phy || !dev_id || !con_id) | 
|  | 73 | return -EINVAL; | 
|  | 74 |  | 
|  | 75 | pl = kzalloc(sizeof(*pl), GFP_KERNEL); | 
|  | 76 | if (!pl) | 
|  | 77 | return -ENOMEM; | 
|  | 78 |  | 
|  | 79 | pl->dev_id = dev_id; | 
|  | 80 | pl->con_id = con_id; | 
|  | 81 | pl->phy = phy; | 
|  | 82 |  | 
|  | 83 | mutex_lock(&phy_provider_mutex); | 
|  | 84 | list_add_tail(&pl->node, &phys); | 
|  | 85 | mutex_unlock(&phy_provider_mutex); | 
|  | 86 |  | 
|  | 87 | return 0; | 
|  | 88 | } | 
|  | 89 | EXPORT_SYMBOL_GPL(phy_create_lookup); | 
|  | 90 |  | 
|  | 91 | /** | 
|  | 92 | * phy_remove_lookup() - find and remove PHY/device association | 
|  | 93 | * @phy: the phy of the association | 
|  | 94 | * @con_id: connection ID string on device | 
|  | 95 | * @dev_id: the device of the association | 
|  | 96 | * | 
|  | 97 | * Finds and unregisters phy_lookup entry that was created with | 
|  | 98 | * phy_create_lookup(). | 
|  | 99 | */ | 
|  | 100 | void phy_remove_lookup(struct phy *phy, const char *con_id, const char *dev_id) | 
|  | 101 | { | 
|  | 102 | struct phy_lookup *pl; | 
|  | 103 |  | 
|  | 104 | if (!phy || !dev_id || !con_id) | 
|  | 105 | return; | 
|  | 106 |  | 
|  | 107 | mutex_lock(&phy_provider_mutex); | 
|  | 108 | list_for_each_entry(pl, &phys, node) | 
|  | 109 | if (pl->phy == phy && !strcmp(pl->dev_id, dev_id) && | 
|  | 110 | !strcmp(pl->con_id, con_id)) { | 
|  | 111 | list_del(&pl->node); | 
|  | 112 | kfree(pl); | 
|  | 113 | break; | 
|  | 114 | } | 
|  | 115 | mutex_unlock(&phy_provider_mutex); | 
|  | 116 | } | 
|  | 117 | EXPORT_SYMBOL_GPL(phy_remove_lookup); | 
|  | 118 |  | 
|  | 119 | static struct phy *phy_find(struct device *dev, const char *con_id) | 
|  | 120 | { | 
|  | 121 | const char *dev_id = dev_name(dev); | 
|  | 122 | struct phy_lookup *p, *pl = NULL; | 
| Heikki Krogerus | b7bc15b | 2014-11-19 17:28:18 +0200 | [diff] [blame] | 123 |  | 
|  | 124 | mutex_lock(&phy_provider_mutex); | 
|  | 125 | list_for_each_entry(p, &phys, node) | 
|  | 126 | if (!strcmp(p->dev_id, dev_id) && !strcmp(p->con_id, con_id)) { | 
|  | 127 | pl = p; | 
|  | 128 | break; | 
|  | 129 | } | 
|  | 130 | mutex_unlock(&phy_provider_mutex); | 
|  | 131 |  | 
| Heikki Krogerus | dbc9863 | 2014-11-19 17:28:21 +0200 | [diff] [blame] | 132 | return pl ? pl->phy : ERR_PTR(-ENODEV); | 
| Heikki Krogerus | b7bc15b | 2014-11-19 17:28:18 +0200 | [diff] [blame] | 133 | } | 
|  | 134 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 135 | static struct phy_provider *of_phy_provider_lookup(struct device_node *node) | 
|  | 136 | { | 
|  | 137 | struct phy_provider *phy_provider; | 
| Kishon Vijay Abraham I | 2a4c370 | 2014-07-14 15:55:01 +0530 | [diff] [blame] | 138 | struct device_node *child; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 139 |  | 
|  | 140 | list_for_each_entry(phy_provider, &phy_provider_list, list) { | 
|  | 141 | if (phy_provider->dev->of_node == node) | 
|  | 142 | return phy_provider; | 
| Kishon Vijay Abraham I | 2a4c370 | 2014-07-14 15:55:01 +0530 | [diff] [blame] | 143 |  | 
|  | 144 | for_each_child_of_node(phy_provider->dev->of_node, child) | 
|  | 145 | if (child == node) | 
|  | 146 | return phy_provider; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 147 | } | 
|  | 148 |  | 
|  | 149 | return ERR_PTR(-EPROBE_DEFER); | 
|  | 150 | } | 
|  | 151 |  | 
|  | 152 | int phy_pm_runtime_get(struct phy *phy) | 
|  | 153 | { | 
| Felipe Balbi | cedb7f8 | 2013-12-20 15:00:48 -0600 | [diff] [blame] | 154 | int ret; | 
|  | 155 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 156 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 157 | return -ENOTSUPP; | 
|  | 158 |  | 
| Felipe Balbi | cedb7f8 | 2013-12-20 15:00:48 -0600 | [diff] [blame] | 159 | ret = pm_runtime_get(&phy->dev); | 
|  | 160 | if (ret < 0 && ret != -EINPROGRESS) | 
|  | 161 | pm_runtime_put_noidle(&phy->dev); | 
|  | 162 |  | 
|  | 163 | return ret; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 164 | } | 
|  | 165 | EXPORT_SYMBOL_GPL(phy_pm_runtime_get); | 
|  | 166 |  | 
|  | 167 | int phy_pm_runtime_get_sync(struct phy *phy) | 
|  | 168 | { | 
| Felipe Balbi | cedb7f8 | 2013-12-20 15:00:48 -0600 | [diff] [blame] | 169 | int ret; | 
|  | 170 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 171 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 172 | return -ENOTSUPP; | 
|  | 173 |  | 
| Felipe Balbi | cedb7f8 | 2013-12-20 15:00:48 -0600 | [diff] [blame] | 174 | ret = pm_runtime_get_sync(&phy->dev); | 
|  | 175 | if (ret < 0) | 
|  | 176 | pm_runtime_put_sync(&phy->dev); | 
|  | 177 |  | 
|  | 178 | return ret; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 179 | } | 
|  | 180 | EXPORT_SYMBOL_GPL(phy_pm_runtime_get_sync); | 
|  | 181 |  | 
|  | 182 | int phy_pm_runtime_put(struct phy *phy) | 
|  | 183 | { | 
|  | 184 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 185 | return -ENOTSUPP; | 
|  | 186 |  | 
|  | 187 | return pm_runtime_put(&phy->dev); | 
|  | 188 | } | 
|  | 189 | EXPORT_SYMBOL_GPL(phy_pm_runtime_put); | 
|  | 190 |  | 
|  | 191 | int phy_pm_runtime_put_sync(struct phy *phy) | 
|  | 192 | { | 
|  | 193 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 194 | return -ENOTSUPP; | 
|  | 195 |  | 
|  | 196 | return pm_runtime_put_sync(&phy->dev); | 
|  | 197 | } | 
|  | 198 | EXPORT_SYMBOL_GPL(phy_pm_runtime_put_sync); | 
|  | 199 |  | 
|  | 200 | void phy_pm_runtime_allow(struct phy *phy) | 
|  | 201 | { | 
|  | 202 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 203 | return; | 
|  | 204 |  | 
|  | 205 | pm_runtime_allow(&phy->dev); | 
|  | 206 | } | 
|  | 207 | EXPORT_SYMBOL_GPL(phy_pm_runtime_allow); | 
|  | 208 |  | 
|  | 209 | void phy_pm_runtime_forbid(struct phy *phy) | 
|  | 210 | { | 
|  | 211 | if (!pm_runtime_enabled(&phy->dev)) | 
|  | 212 | return; | 
|  | 213 |  | 
|  | 214 | pm_runtime_forbid(&phy->dev); | 
|  | 215 | } | 
|  | 216 | EXPORT_SYMBOL_GPL(phy_pm_runtime_forbid); | 
|  | 217 |  | 
|  | 218 | int phy_init(struct phy *phy) | 
|  | 219 | { | 
|  | 220 | int ret; | 
|  | 221 |  | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 222 | if (!phy) | 
|  | 223 | return 0; | 
|  | 224 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 225 | ret = phy_pm_runtime_get_sync(phy); | 
|  | 226 | if (ret < 0 && ret != -ENOTSUPP) | 
|  | 227 | return ret; | 
| Axel Lin | 736b67a | 2015-03-06 15:55:10 +0800 | [diff] [blame] | 228 | ret = 0; /* Override possible ret == -ENOTSUPP */ | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 229 |  | 
|  | 230 | mutex_lock(&phy->mutex); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 231 | if (phy->init_count == 0 && phy->ops->init) { | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 232 | ret = phy->ops->init(phy); | 
|  | 233 | if (ret < 0) { | 
|  | 234 | dev_err(&phy->dev, "phy init failed --> %d\n", ret); | 
|  | 235 | goto out; | 
|  | 236 | } | 
|  | 237 | } | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 238 | ++phy->init_count; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 239 |  | 
|  | 240 | out: | 
|  | 241 | mutex_unlock(&phy->mutex); | 
|  | 242 | phy_pm_runtime_put(phy); | 
|  | 243 | return ret; | 
|  | 244 | } | 
|  | 245 | EXPORT_SYMBOL_GPL(phy_init); | 
|  | 246 |  | 
|  | 247 | int phy_exit(struct phy *phy) | 
|  | 248 | { | 
|  | 249 | int ret; | 
|  | 250 |  | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 251 | if (!phy) | 
|  | 252 | return 0; | 
|  | 253 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 254 | ret = phy_pm_runtime_get_sync(phy); | 
|  | 255 | if (ret < 0 && ret != -ENOTSUPP) | 
|  | 256 | return ret; | 
| Axel Lin | 736b67a | 2015-03-06 15:55:10 +0800 | [diff] [blame] | 257 | ret = 0; /* Override possible ret == -ENOTSUPP */ | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 258 |  | 
|  | 259 | mutex_lock(&phy->mutex); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 260 | if (phy->init_count == 1 && phy->ops->exit) { | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 261 | ret = phy->ops->exit(phy); | 
|  | 262 | if (ret < 0) { | 
|  | 263 | dev_err(&phy->dev, "phy exit failed --> %d\n", ret); | 
|  | 264 | goto out; | 
|  | 265 | } | 
|  | 266 | } | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 267 | --phy->init_count; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 268 |  | 
|  | 269 | out: | 
|  | 270 | mutex_unlock(&phy->mutex); | 
|  | 271 | phy_pm_runtime_put(phy); | 
|  | 272 | return ret; | 
|  | 273 | } | 
|  | 274 | EXPORT_SYMBOL_GPL(phy_exit); | 
|  | 275 |  | 
|  | 276 | int phy_power_on(struct phy *phy) | 
|  | 277 | { | 
| Kishon Vijay Abraham I | d18c960 | 2013-12-19 20:01:44 +0530 | [diff] [blame] | 278 | int ret; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 279 |  | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 280 | if (!phy) | 
|  | 281 | return 0; | 
|  | 282 |  | 
| Roger Quadros | 3be8812 | 2014-07-04 12:55:45 +0300 | [diff] [blame] | 283 | if (phy->pwr) { | 
|  | 284 | ret = regulator_enable(phy->pwr); | 
|  | 285 | if (ret) | 
|  | 286 | return ret; | 
|  | 287 | } | 
|  | 288 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 289 | ret = phy_pm_runtime_get_sync(phy); | 
|  | 290 | if (ret < 0 && ret != -ENOTSUPP) | 
|  | 291 | return ret; | 
| Axel Lin | 736b67a | 2015-03-06 15:55:10 +0800 | [diff] [blame] | 292 | ret = 0; /* Override possible ret == -ENOTSUPP */ | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 293 |  | 
|  | 294 | mutex_lock(&phy->mutex); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 295 | if (phy->power_count == 0 && phy->ops->power_on) { | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 296 | ret = phy->ops->power_on(phy); | 
|  | 297 | if (ret < 0) { | 
|  | 298 | dev_err(&phy->dev, "phy poweron failed --> %d\n", ret); | 
|  | 299 | goto out; | 
|  | 300 | } | 
|  | 301 | } | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 302 | ++phy->power_count; | 
|  | 303 | mutex_unlock(&phy->mutex); | 
|  | 304 | return 0; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 305 |  | 
|  | 306 | out: | 
|  | 307 | mutex_unlock(&phy->mutex); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 308 | phy_pm_runtime_put_sync(phy); | 
| Roger Quadros | 3be8812 | 2014-07-04 12:55:45 +0300 | [diff] [blame] | 309 | if (phy->pwr) | 
|  | 310 | regulator_disable(phy->pwr); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 311 |  | 
|  | 312 | return ret; | 
|  | 313 | } | 
|  | 314 | EXPORT_SYMBOL_GPL(phy_power_on); | 
|  | 315 |  | 
|  | 316 | int phy_power_off(struct phy *phy) | 
|  | 317 | { | 
| Kishon Vijay Abraham I | d18c960 | 2013-12-19 20:01:44 +0530 | [diff] [blame] | 318 | int ret; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 319 |  | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 320 | if (!phy) | 
|  | 321 | return 0; | 
|  | 322 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 323 | mutex_lock(&phy->mutex); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 324 | if (phy->power_count == 1 && phy->ops->power_off) { | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 325 | ret =  phy->ops->power_off(phy); | 
|  | 326 | if (ret < 0) { | 
|  | 327 | dev_err(&phy->dev, "phy poweroff failed --> %d\n", ret); | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 328 | mutex_unlock(&phy->mutex); | 
|  | 329 | return ret; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 330 | } | 
|  | 331 | } | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 332 | --phy->power_count; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 333 | mutex_unlock(&phy->mutex); | 
|  | 334 | phy_pm_runtime_put(phy); | 
|  | 335 |  | 
| Roger Quadros | 3be8812 | 2014-07-04 12:55:45 +0300 | [diff] [blame] | 336 | if (phy->pwr) | 
|  | 337 | regulator_disable(phy->pwr); | 
|  | 338 |  | 
| Kishon Vijay Abraham I | 637d378 | 2013-12-20 10:36:49 +0530 | [diff] [blame] | 339 | return 0; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 340 | } | 
|  | 341 | EXPORT_SYMBOL_GPL(phy_power_off); | 
|  | 342 |  | 
|  | 343 | /** | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 344 | * _of_phy_get() - lookup and obtain a reference to a phy by phandle | 
|  | 345 | * @np: device_node for which to get the phy | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 346 | * @index: the index of the phy | 
|  | 347 | * | 
|  | 348 | * Returns the phy associated with the given phandle value, | 
|  | 349 | * after getting a refcount to it or -ENODEV if there is no such phy or | 
|  | 350 | * -EPROBE_DEFER if there is a phandle to the phy, but the device is | 
|  | 351 | * not yet loaded. This function uses of_xlate call back function provided | 
|  | 352 | * while registering the phy_provider to find the phy instance. | 
|  | 353 | */ | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 354 | static struct phy *_of_phy_get(struct device_node *np, int index) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 355 | { | 
|  | 356 | int ret; | 
|  | 357 | struct phy_provider *phy_provider; | 
|  | 358 | struct phy *phy = NULL; | 
|  | 359 | struct of_phandle_args args; | 
|  | 360 |  | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 361 | ret = of_parse_phandle_with_args(np, "phys", "#phy-cells", | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 362 | index, &args); | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 363 | if (ret) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 364 | return ERR_PTR(-ENODEV); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 365 |  | 
|  | 366 | mutex_lock(&phy_provider_mutex); | 
|  | 367 | phy_provider = of_phy_provider_lookup(args.np); | 
|  | 368 | if (IS_ERR(phy_provider) || !try_module_get(phy_provider->owner)) { | 
|  | 369 | phy = ERR_PTR(-EPROBE_DEFER); | 
| Axel Lin | 33f434d | 2015-04-07 12:23:38 +0800 | [diff] [blame] | 370 | goto out_unlock; | 
|  | 371 | } | 
|  | 372 |  | 
|  | 373 | if (!of_device_is_available(args.np)) { | 
|  | 374 | dev_warn(phy_provider->dev, "Requested PHY is disabled\n"); | 
|  | 375 | phy = ERR_PTR(-ENODEV); | 
|  | 376 | goto out_put_module; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 377 | } | 
|  | 378 |  | 
|  | 379 | phy = phy_provider->of_xlate(phy_provider->dev, &args); | 
| Axel Lin | 33f434d | 2015-04-07 12:23:38 +0800 | [diff] [blame] | 380 |  | 
|  | 381 | out_put_module: | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 382 | module_put(phy_provider->owner); | 
|  | 383 |  | 
| Axel Lin | 33f434d | 2015-04-07 12:23:38 +0800 | [diff] [blame] | 384 | out_unlock: | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 385 | mutex_unlock(&phy_provider_mutex); | 
|  | 386 | of_node_put(args.np); | 
|  | 387 |  | 
|  | 388 | return phy; | 
|  | 389 | } | 
|  | 390 |  | 
|  | 391 | /** | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 392 | * of_phy_get() - lookup and obtain a reference to a phy using a device_node. | 
|  | 393 | * @np: device_node for which to get the phy | 
|  | 394 | * @con_id: name of the phy from device's point of view | 
|  | 395 | * | 
|  | 396 | * Returns the phy driver, after getting a refcount to it; or | 
|  | 397 | * -ENODEV if there is no such phy. The caller is responsible for | 
|  | 398 | * calling phy_put() to release that count. | 
|  | 399 | */ | 
|  | 400 | struct phy *of_phy_get(struct device_node *np, const char *con_id) | 
|  | 401 | { | 
|  | 402 | struct phy *phy = NULL; | 
|  | 403 | int index = 0; | 
|  | 404 |  | 
|  | 405 | if (con_id) | 
|  | 406 | index = of_property_match_string(np, "phy-names", con_id); | 
|  | 407 |  | 
|  | 408 | phy = _of_phy_get(np, index); | 
|  | 409 | if (IS_ERR(phy)) | 
|  | 410 | return phy; | 
|  | 411 |  | 
|  | 412 | if (!try_module_get(phy->ops->owner)) | 
|  | 413 | return ERR_PTR(-EPROBE_DEFER); | 
|  | 414 |  | 
|  | 415 | get_device(&phy->dev); | 
|  | 416 |  | 
|  | 417 | return phy; | 
|  | 418 | } | 
|  | 419 | EXPORT_SYMBOL_GPL(of_phy_get); | 
|  | 420 |  | 
|  | 421 | /** | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 422 | * phy_put() - release the PHY | 
|  | 423 | * @phy: the phy returned by phy_get() | 
|  | 424 | * | 
|  | 425 | * Releases a refcount the caller received from phy_get(). | 
|  | 426 | */ | 
|  | 427 | void phy_put(struct phy *phy) | 
|  | 428 | { | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 429 | if (!phy || IS_ERR(phy)) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 430 | return; | 
|  | 431 |  | 
|  | 432 | module_put(phy->ops->owner); | 
|  | 433 | put_device(&phy->dev); | 
|  | 434 | } | 
|  | 435 | EXPORT_SYMBOL_GPL(phy_put); | 
|  | 436 |  | 
|  | 437 | /** | 
|  | 438 | * devm_phy_put() - release the PHY | 
|  | 439 | * @dev: device that wants to release this phy | 
|  | 440 | * @phy: the phy returned by devm_phy_get() | 
|  | 441 | * | 
|  | 442 | * destroys the devres associated with this phy and invokes phy_put | 
|  | 443 | * to release the phy. | 
|  | 444 | */ | 
|  | 445 | void devm_phy_put(struct device *dev, struct phy *phy) | 
|  | 446 | { | 
|  | 447 | int r; | 
|  | 448 |  | 
| Andrew Lunn | 04c2fac | 2014-02-04 18:33:11 +0100 | [diff] [blame] | 449 | if (!phy) | 
|  | 450 | return; | 
|  | 451 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 452 | r = devres_destroy(dev, devm_phy_release, devm_phy_match, phy); | 
|  | 453 | dev_WARN_ONCE(dev, r, "couldn't find PHY resource\n"); | 
|  | 454 | } | 
|  | 455 | EXPORT_SYMBOL_GPL(devm_phy_put); | 
|  | 456 |  | 
|  | 457 | /** | 
|  | 458 | * of_phy_simple_xlate() - returns the phy instance from phy provider | 
|  | 459 | * @dev: the PHY provider device | 
|  | 460 | * @args: of_phandle_args (not used here) | 
|  | 461 | * | 
|  | 462 | * Intended to be used by phy provider for the common case where #phy-cells is | 
|  | 463 | * 0. For other cases where #phy-cells is greater than '0', the phy provider | 
|  | 464 | * should provide a custom of_xlate function that reads the *args* and returns | 
|  | 465 | * the appropriate phy. | 
|  | 466 | */ | 
|  | 467 | struct phy *of_phy_simple_xlate(struct device *dev, struct of_phandle_args | 
|  | 468 | *args) | 
|  | 469 | { | 
|  | 470 | struct phy *phy; | 
|  | 471 | struct class_dev_iter iter; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 472 |  | 
|  | 473 | class_dev_iter_init(&iter, phy_class, NULL, NULL); | 
|  | 474 | while ((dev = class_dev_iter_next(&iter))) { | 
|  | 475 | phy = to_phy(dev); | 
| Kishon Vijay Abraham I | 491e049 | 2014-10-31 14:04:20 +0530 | [diff] [blame] | 476 | if (args->np != phy->dev.of_node) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 477 | continue; | 
|  | 478 |  | 
|  | 479 | class_dev_iter_exit(&iter); | 
|  | 480 | return phy; | 
|  | 481 | } | 
|  | 482 |  | 
|  | 483 | class_dev_iter_exit(&iter); | 
|  | 484 | return ERR_PTR(-ENODEV); | 
|  | 485 | } | 
|  | 486 | EXPORT_SYMBOL_GPL(of_phy_simple_xlate); | 
|  | 487 |  | 
|  | 488 | /** | 
|  | 489 | * phy_get() - lookup and obtain a reference to a phy. | 
|  | 490 | * @dev: device that requests this phy | 
|  | 491 | * @string: the phy name as given in the dt data or the name of the controller | 
|  | 492 | * port for non-dt case | 
|  | 493 | * | 
|  | 494 | * Returns the phy driver, after getting a refcount to it; or | 
|  | 495 | * -ENODEV if there is no such phy.  The caller is responsible for | 
|  | 496 | * calling phy_put() to release that count. | 
|  | 497 | */ | 
|  | 498 | struct phy *phy_get(struct device *dev, const char *string) | 
|  | 499 | { | 
|  | 500 | int index = 0; | 
| Kishon Vijay Abraham I | d18c960 | 2013-12-19 20:01:44 +0530 | [diff] [blame] | 501 | struct phy *phy; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 502 |  | 
|  | 503 | if (string == NULL) { | 
|  | 504 | dev_WARN(dev, "missing string\n"); | 
|  | 505 | return ERR_PTR(-EINVAL); | 
|  | 506 | } | 
|  | 507 |  | 
|  | 508 | if (dev->of_node) { | 
|  | 509 | index = of_property_match_string(dev->of_node, "phy-names", | 
|  | 510 | string); | 
| Kamil Debski | 0b3f3b2 | 2014-03-06 12:16:46 +0100 | [diff] [blame] | 511 | phy = _of_phy_get(dev->of_node, index); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 512 | } else { | 
| Heikki Krogerus | b7bc15b | 2014-11-19 17:28:18 +0200 | [diff] [blame] | 513 | phy = phy_find(dev, string); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 514 | } | 
| Hans de Goede | f40037f | 2014-02-17 14:29:22 +0530 | [diff] [blame] | 515 | if (IS_ERR(phy)) | 
|  | 516 | return phy; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 517 |  | 
|  | 518 | if (!try_module_get(phy->ops->owner)) | 
|  | 519 | return ERR_PTR(-EPROBE_DEFER); | 
|  | 520 |  | 
|  | 521 | get_device(&phy->dev); | 
|  | 522 |  | 
|  | 523 | return phy; | 
|  | 524 | } | 
|  | 525 | EXPORT_SYMBOL_GPL(phy_get); | 
|  | 526 |  | 
|  | 527 | /** | 
| Andrew Lunn | 788a4d5 | 2014-02-04 18:33:12 +0100 | [diff] [blame] | 528 | * phy_optional_get() - lookup and obtain a reference to an optional phy. | 
|  | 529 | * @dev: device that requests this phy | 
|  | 530 | * @string: the phy name as given in the dt data or the name of the controller | 
|  | 531 | * port for non-dt case | 
|  | 532 | * | 
|  | 533 | * Returns the phy driver, after getting a refcount to it; or | 
|  | 534 | * NULL if there is no such phy.  The caller is responsible for | 
|  | 535 | * calling phy_put() to release that count. | 
|  | 536 | */ | 
|  | 537 | struct phy *phy_optional_get(struct device *dev, const char *string) | 
|  | 538 | { | 
|  | 539 | struct phy *phy = phy_get(dev, string); | 
|  | 540 |  | 
| Axel Lin | f83be4c | 2015-04-08 07:30:15 +0800 | [diff] [blame] | 541 | if (IS_ERR(phy) && (PTR_ERR(phy) == -ENODEV)) | 
| Andrew Lunn | 788a4d5 | 2014-02-04 18:33:12 +0100 | [diff] [blame] | 542 | phy = NULL; | 
|  | 543 |  | 
|  | 544 | return phy; | 
|  | 545 | } | 
|  | 546 | EXPORT_SYMBOL_GPL(phy_optional_get); | 
|  | 547 |  | 
|  | 548 | /** | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 549 | * devm_phy_get() - lookup and obtain a reference to a phy. | 
|  | 550 | * @dev: device that requests this phy | 
|  | 551 | * @string: the phy name as given in the dt data or phy device name | 
|  | 552 | * for non-dt case | 
|  | 553 | * | 
|  | 554 | * Gets the phy using phy_get(), and associates a device with it using | 
|  | 555 | * devres. On driver detach, release function is invoked on the devres data, | 
|  | 556 | * then, devres data is freed. | 
|  | 557 | */ | 
|  | 558 | struct phy *devm_phy_get(struct device *dev, const char *string) | 
|  | 559 | { | 
|  | 560 | struct phy **ptr, *phy; | 
|  | 561 |  | 
|  | 562 | ptr = devres_alloc(devm_phy_release, sizeof(*ptr), GFP_KERNEL); | 
|  | 563 | if (!ptr) | 
|  | 564 | return ERR_PTR(-ENOMEM); | 
|  | 565 |  | 
|  | 566 | phy = phy_get(dev, string); | 
|  | 567 | if (!IS_ERR(phy)) { | 
|  | 568 | *ptr = phy; | 
|  | 569 | devres_add(dev, ptr); | 
|  | 570 | } else { | 
|  | 571 | devres_free(ptr); | 
|  | 572 | } | 
|  | 573 |  | 
|  | 574 | return phy; | 
|  | 575 | } | 
|  | 576 | EXPORT_SYMBOL_GPL(devm_phy_get); | 
|  | 577 |  | 
|  | 578 | /** | 
| Andrew Lunn | 788a4d5 | 2014-02-04 18:33:12 +0100 | [diff] [blame] | 579 | * devm_phy_optional_get() - lookup and obtain a reference to an optional phy. | 
|  | 580 | * @dev: device that requests this phy | 
|  | 581 | * @string: the phy name as given in the dt data or phy device name | 
|  | 582 | * for non-dt case | 
|  | 583 | * | 
|  | 584 | * Gets the phy using phy_get(), and associates a device with it using | 
|  | 585 | * devres. On driver detach, release function is invoked on the devres | 
|  | 586 | * data, then, devres data is freed. This differs to devm_phy_get() in | 
|  | 587 | * that if the phy does not exist, it is not considered an error and | 
|  | 588 | * -ENODEV will not be returned. Instead the NULL phy is returned, | 
|  | 589 | * which can be passed to all other phy consumer calls. | 
|  | 590 | */ | 
|  | 591 | struct phy *devm_phy_optional_get(struct device *dev, const char *string) | 
|  | 592 | { | 
|  | 593 | struct phy *phy = devm_phy_get(dev, string); | 
|  | 594 |  | 
| Axel Lin | f83be4c | 2015-04-08 07:30:15 +0800 | [diff] [blame] | 595 | if (IS_ERR(phy) && (PTR_ERR(phy) == -ENODEV)) | 
| Andrew Lunn | 788a4d5 | 2014-02-04 18:33:12 +0100 | [diff] [blame] | 596 | phy = NULL; | 
|  | 597 |  | 
|  | 598 | return phy; | 
|  | 599 | } | 
|  | 600 | EXPORT_SYMBOL_GPL(devm_phy_optional_get); | 
|  | 601 |  | 
|  | 602 | /** | 
| Kamil Debski | b5d682f | 2014-03-06 12:16:47 +0100 | [diff] [blame] | 603 | * devm_of_phy_get() - lookup and obtain a reference to a phy. | 
|  | 604 | * @dev: device that requests this phy | 
|  | 605 | * @np: node containing the phy | 
|  | 606 | * @con_id: name of the phy from device's point of view | 
|  | 607 | * | 
|  | 608 | * Gets the phy using of_phy_get(), and associates a device with it using | 
|  | 609 | * devres. On driver detach, release function is invoked on the devres data, | 
|  | 610 | * then, devres data is freed. | 
|  | 611 | */ | 
|  | 612 | struct phy *devm_of_phy_get(struct device *dev, struct device_node *np, | 
|  | 613 | const char *con_id) | 
|  | 614 | { | 
|  | 615 | struct phy **ptr, *phy; | 
|  | 616 |  | 
|  | 617 | ptr = devres_alloc(devm_phy_release, sizeof(*ptr), GFP_KERNEL); | 
|  | 618 | if (!ptr) | 
|  | 619 | return ERR_PTR(-ENOMEM); | 
|  | 620 |  | 
|  | 621 | phy = of_phy_get(np, con_id); | 
|  | 622 | if (!IS_ERR(phy)) { | 
|  | 623 | *ptr = phy; | 
|  | 624 | devres_add(dev, ptr); | 
|  | 625 | } else { | 
|  | 626 | devres_free(ptr); | 
|  | 627 | } | 
|  | 628 |  | 
|  | 629 | return phy; | 
|  | 630 | } | 
|  | 631 | EXPORT_SYMBOL_GPL(devm_of_phy_get); | 
|  | 632 |  | 
|  | 633 | /** | 
| Arun Ramamurthy | 6be109b | 2015-04-22 16:04:11 -0700 | [diff] [blame] | 634 | * devm_of_phy_get_by_index() - lookup and obtain a reference to a phy by index. | 
|  | 635 | * @dev: device that requests this phy | 
|  | 636 | * @np: node containing the phy | 
|  | 637 | * @index: index of the phy | 
|  | 638 | * | 
| Chunfeng Yun | 70874462 | 2015-12-04 10:06:29 +0800 | [diff] [blame] | 639 | * Gets the phy using _of_phy_get(), then gets a refcount to it, | 
|  | 640 | * and associates a device with it using devres. On driver detach, | 
|  | 641 | * release function is invoked on the devres data, | 
| Arun Ramamurthy | 6be109b | 2015-04-22 16:04:11 -0700 | [diff] [blame] | 642 | * then, devres data is freed. | 
|  | 643 | * | 
|  | 644 | */ | 
|  | 645 | struct phy *devm_of_phy_get_by_index(struct device *dev, struct device_node *np, | 
|  | 646 | int index) | 
|  | 647 | { | 
|  | 648 | struct phy **ptr, *phy; | 
|  | 649 |  | 
|  | 650 | ptr = devres_alloc(devm_phy_release, sizeof(*ptr), GFP_KERNEL); | 
|  | 651 | if (!ptr) | 
|  | 652 | return ERR_PTR(-ENOMEM); | 
|  | 653 |  | 
|  | 654 | phy = _of_phy_get(np, index); | 
| Chunfeng Yun | 70874462 | 2015-12-04 10:06:29 +0800 | [diff] [blame] | 655 | if (IS_ERR(phy)) { | 
| Arun Ramamurthy | 6be109b | 2015-04-22 16:04:11 -0700 | [diff] [blame] | 656 | devres_free(ptr); | 
| Chunfeng Yun | 70874462 | 2015-12-04 10:06:29 +0800 | [diff] [blame] | 657 | return phy; | 
| Arun Ramamurthy | 6be109b | 2015-04-22 16:04:11 -0700 | [diff] [blame] | 658 | } | 
|  | 659 |  | 
| Chunfeng Yun | 70874462 | 2015-12-04 10:06:29 +0800 | [diff] [blame] | 660 | if (!try_module_get(phy->ops->owner)) { | 
|  | 661 | devres_free(ptr); | 
|  | 662 | return ERR_PTR(-EPROBE_DEFER); | 
|  | 663 | } | 
|  | 664 |  | 
|  | 665 | get_device(&phy->dev); | 
|  | 666 |  | 
|  | 667 | *ptr = phy; | 
|  | 668 | devres_add(dev, ptr); | 
|  | 669 |  | 
| Arun Ramamurthy | 6be109b | 2015-04-22 16:04:11 -0700 | [diff] [blame] | 670 | return phy; | 
|  | 671 | } | 
|  | 672 | EXPORT_SYMBOL_GPL(devm_of_phy_get_by_index); | 
|  | 673 |  | 
|  | 674 | /** | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 675 | * phy_create() - create a new phy | 
|  | 676 | * @dev: device that is creating the new phy | 
| Kishon Vijay Abraham I | f0ed817 | 2014-07-14 15:55:02 +0530 | [diff] [blame] | 677 | * @node: device node of the phy | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 678 | * @ops: function pointers for performing phy operations | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 679 | * | 
|  | 680 | * Called to create a phy using phy framework. | 
|  | 681 | */ | 
| Kishon Vijay Abraham I | f0ed817 | 2014-07-14 15:55:02 +0530 | [diff] [blame] | 682 | struct phy *phy_create(struct device *dev, struct device_node *node, | 
| Heikki Krogerus | dbc9863 | 2014-11-19 17:28:21 +0200 | [diff] [blame] | 683 | const struct phy_ops *ops) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 684 | { | 
|  | 685 | int ret; | 
|  | 686 | int id; | 
|  | 687 | struct phy *phy; | 
|  | 688 |  | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 689 | if (WARN_ON(!dev)) | 
|  | 690 | return ERR_PTR(-EINVAL); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 691 |  | 
|  | 692 | phy = kzalloc(sizeof(*phy), GFP_KERNEL); | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 693 | if (!phy) | 
|  | 694 | return ERR_PTR(-ENOMEM); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 695 |  | 
|  | 696 | id = ida_simple_get(&phy_ida, 0, 0, GFP_KERNEL); | 
|  | 697 | if (id < 0) { | 
|  | 698 | dev_err(dev, "unable to get id\n"); | 
|  | 699 | ret = id; | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 700 | goto free_phy; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 701 | } | 
|  | 702 |  | 
|  | 703 | device_initialize(&phy->dev); | 
|  | 704 | mutex_init(&phy->mutex); | 
|  | 705 |  | 
|  | 706 | phy->dev.class = phy_class; | 
|  | 707 | phy->dev.parent = dev; | 
| Kishon Vijay Abraham I | f0ed817 | 2014-07-14 15:55:02 +0530 | [diff] [blame] | 708 | phy->dev.of_node = node ?: dev->of_node; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 709 | phy->id = id; | 
|  | 710 | phy->ops = ops; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 711 |  | 
|  | 712 | ret = dev_set_name(&phy->dev, "phy-%s.%d", dev_name(dev), id); | 
|  | 713 | if (ret) | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 714 | goto put_dev; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 715 |  | 
| Dmitry Torokhov | 87006dd | 2015-04-22 16:14:37 -0700 | [diff] [blame] | 716 | /* phy-supply */ | 
|  | 717 | phy->pwr = regulator_get_optional(&phy->dev, "phy"); | 
|  | 718 | if (IS_ERR(phy->pwr)) { | 
|  | 719 | ret = PTR_ERR(phy->pwr); | 
|  | 720 | if (ret == -EPROBE_DEFER) | 
|  | 721 | goto put_dev; | 
|  | 722 |  | 
|  | 723 | phy->pwr = NULL; | 
|  | 724 | } | 
|  | 725 |  | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 726 | ret = device_add(&phy->dev); | 
|  | 727 | if (ret) | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 728 | goto put_dev; | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 729 |  | 
|  | 730 | if (pm_runtime_enabled(dev)) { | 
|  | 731 | pm_runtime_enable(&phy->dev); | 
|  | 732 | pm_runtime_no_callbacks(&phy->dev); | 
|  | 733 | } | 
|  | 734 |  | 
|  | 735 | return phy; | 
|  | 736 |  | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 737 | put_dev: | 
| Roger Quadros | e73b49f | 2014-07-10 11:55:02 +0530 | [diff] [blame] | 738 | put_device(&phy->dev);  /* calls phy_release() which frees resources */ | 
|  | 739 | return ERR_PTR(ret); | 
|  | 740 |  | 
| Dan Carpenter | 52797d2 | 2013-12-06 17:51:19 +0530 | [diff] [blame] | 741 | free_phy: | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 742 | kfree(phy); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 743 | return ERR_PTR(ret); | 
|  | 744 | } | 
|  | 745 | EXPORT_SYMBOL_GPL(phy_create); | 
|  | 746 |  | 
|  | 747 | /** | 
|  | 748 | * devm_phy_create() - create a new phy | 
|  | 749 | * @dev: device that is creating the new phy | 
| Kishon Vijay Abraham I | f0ed817 | 2014-07-14 15:55:02 +0530 | [diff] [blame] | 750 | * @node: device node of the phy | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 751 | * @ops: function pointers for performing phy operations | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 752 | * | 
|  | 753 | * Creates a new PHY device adding it to the PHY class. | 
|  | 754 | * While at that, it also associates the device with the phy using devres. | 
|  | 755 | * On driver detach, release function is invoked on the devres data, | 
|  | 756 | * then, devres data is freed. | 
|  | 757 | */ | 
| Kishon Vijay Abraham I | f0ed817 | 2014-07-14 15:55:02 +0530 | [diff] [blame] | 758 | struct phy *devm_phy_create(struct device *dev, struct device_node *node, | 
| Heikki Krogerus | dbc9863 | 2014-11-19 17:28:21 +0200 | [diff] [blame] | 759 | const struct phy_ops *ops) | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 760 | { | 
|  | 761 | struct phy **ptr, *phy; | 
|  | 762 |  | 
|  | 763 | ptr = devres_alloc(devm_phy_consume, sizeof(*ptr), GFP_KERNEL); | 
|  | 764 | if (!ptr) | 
|  | 765 | return ERR_PTR(-ENOMEM); | 
|  | 766 |  | 
| Heikki Krogerus | dbc9863 | 2014-11-19 17:28:21 +0200 | [diff] [blame] | 767 | phy = phy_create(dev, node, ops); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 768 | if (!IS_ERR(phy)) { | 
|  | 769 | *ptr = phy; | 
|  | 770 | devres_add(dev, ptr); | 
|  | 771 | } else { | 
|  | 772 | devres_free(ptr); | 
|  | 773 | } | 
|  | 774 |  | 
|  | 775 | return phy; | 
|  | 776 | } | 
|  | 777 | EXPORT_SYMBOL_GPL(devm_phy_create); | 
|  | 778 |  | 
|  | 779 | /** | 
|  | 780 | * phy_destroy() - destroy the phy | 
|  | 781 | * @phy: the phy to be destroyed | 
|  | 782 | * | 
|  | 783 | * Called to destroy the phy. | 
|  | 784 | */ | 
|  | 785 | void phy_destroy(struct phy *phy) | 
|  | 786 | { | 
|  | 787 | pm_runtime_disable(&phy->dev); | 
|  | 788 | device_unregister(&phy->dev); | 
|  | 789 | } | 
|  | 790 | EXPORT_SYMBOL_GPL(phy_destroy); | 
|  | 791 |  | 
|  | 792 | /** | 
|  | 793 | * devm_phy_destroy() - destroy the PHY | 
|  | 794 | * @dev: device that wants to release this phy | 
|  | 795 | * @phy: the phy returned by devm_phy_get() | 
|  | 796 | * | 
|  | 797 | * destroys the devres associated with this phy and invokes phy_destroy | 
|  | 798 | * to destroy the phy. | 
|  | 799 | */ | 
|  | 800 | void devm_phy_destroy(struct device *dev, struct phy *phy) | 
|  | 801 | { | 
|  | 802 | int r; | 
|  | 803 |  | 
|  | 804 | r = devres_destroy(dev, devm_phy_consume, devm_phy_match, phy); | 
|  | 805 | dev_WARN_ONCE(dev, r, "couldn't find PHY resource\n"); | 
|  | 806 | } | 
|  | 807 | EXPORT_SYMBOL_GPL(devm_phy_destroy); | 
|  | 808 |  | 
|  | 809 | /** | 
|  | 810 | * __of_phy_provider_register() - create/register phy provider with the framework | 
|  | 811 | * @dev: struct device of the phy provider | 
|  | 812 | * @owner: the module owner containing of_xlate | 
|  | 813 | * @of_xlate: function pointer to obtain phy instance from phy provider | 
|  | 814 | * | 
|  | 815 | * Creates struct phy_provider from dev and of_xlate function pointer. | 
|  | 816 | * This is used in the case of dt boot for finding the phy instance from | 
|  | 817 | * phy provider. | 
|  | 818 | */ | 
|  | 819 | struct phy_provider *__of_phy_provider_register(struct device *dev, | 
|  | 820 | struct module *owner, struct phy * (*of_xlate)(struct device *dev, | 
|  | 821 | struct of_phandle_args *args)) | 
|  | 822 | { | 
|  | 823 | struct phy_provider *phy_provider; | 
|  | 824 |  | 
|  | 825 | phy_provider = kzalloc(sizeof(*phy_provider), GFP_KERNEL); | 
|  | 826 | if (!phy_provider) | 
|  | 827 | return ERR_PTR(-ENOMEM); | 
|  | 828 |  | 
|  | 829 | phy_provider->dev = dev; | 
|  | 830 | phy_provider->owner = owner; | 
|  | 831 | phy_provider->of_xlate = of_xlate; | 
|  | 832 |  | 
|  | 833 | mutex_lock(&phy_provider_mutex); | 
|  | 834 | list_add_tail(&phy_provider->list, &phy_provider_list); | 
|  | 835 | mutex_unlock(&phy_provider_mutex); | 
|  | 836 |  | 
|  | 837 | return phy_provider; | 
|  | 838 | } | 
|  | 839 | EXPORT_SYMBOL_GPL(__of_phy_provider_register); | 
|  | 840 |  | 
|  | 841 | /** | 
|  | 842 | * __devm_of_phy_provider_register() - create/register phy provider with the | 
|  | 843 | * framework | 
|  | 844 | * @dev: struct device of the phy provider | 
|  | 845 | * @owner: the module owner containing of_xlate | 
|  | 846 | * @of_xlate: function pointer to obtain phy instance from phy provider | 
|  | 847 | * | 
|  | 848 | * Creates struct phy_provider from dev and of_xlate function pointer. | 
|  | 849 | * This is used in the case of dt boot for finding the phy instance from | 
|  | 850 | * phy provider. While at that, it also associates the device with the | 
|  | 851 | * phy provider using devres. On driver detach, release function is invoked | 
|  | 852 | * on the devres data, then, devres data is freed. | 
|  | 853 | */ | 
|  | 854 | struct phy_provider *__devm_of_phy_provider_register(struct device *dev, | 
|  | 855 | struct module *owner, struct phy * (*of_xlate)(struct device *dev, | 
|  | 856 | struct of_phandle_args *args)) | 
|  | 857 | { | 
|  | 858 | struct phy_provider **ptr, *phy_provider; | 
|  | 859 |  | 
|  | 860 | ptr = devres_alloc(devm_phy_provider_release, sizeof(*ptr), GFP_KERNEL); | 
|  | 861 | if (!ptr) | 
|  | 862 | return ERR_PTR(-ENOMEM); | 
|  | 863 |  | 
|  | 864 | phy_provider = __of_phy_provider_register(dev, owner, of_xlate); | 
|  | 865 | if (!IS_ERR(phy_provider)) { | 
|  | 866 | *ptr = phy_provider; | 
|  | 867 | devres_add(dev, ptr); | 
|  | 868 | } else { | 
|  | 869 | devres_free(ptr); | 
|  | 870 | } | 
|  | 871 |  | 
|  | 872 | return phy_provider; | 
|  | 873 | } | 
|  | 874 | EXPORT_SYMBOL_GPL(__devm_of_phy_provider_register); | 
|  | 875 |  | 
|  | 876 | /** | 
|  | 877 | * of_phy_provider_unregister() - unregister phy provider from the framework | 
|  | 878 | * @phy_provider: phy provider returned by of_phy_provider_register() | 
|  | 879 | * | 
|  | 880 | * Removes the phy_provider created using of_phy_provider_register(). | 
|  | 881 | */ | 
|  | 882 | void of_phy_provider_unregister(struct phy_provider *phy_provider) | 
|  | 883 | { | 
|  | 884 | if (IS_ERR(phy_provider)) | 
|  | 885 | return; | 
|  | 886 |  | 
|  | 887 | mutex_lock(&phy_provider_mutex); | 
|  | 888 | list_del(&phy_provider->list); | 
|  | 889 | kfree(phy_provider); | 
|  | 890 | mutex_unlock(&phy_provider_mutex); | 
|  | 891 | } | 
|  | 892 | EXPORT_SYMBOL_GPL(of_phy_provider_unregister); | 
|  | 893 |  | 
|  | 894 | /** | 
|  | 895 | * devm_of_phy_provider_unregister() - remove phy provider from the framework | 
|  | 896 | * @dev: struct device of the phy provider | 
|  | 897 | * | 
|  | 898 | * destroys the devres associated with this phy provider and invokes | 
|  | 899 | * of_phy_provider_unregister to unregister the phy provider. | 
|  | 900 | */ | 
|  | 901 | void devm_of_phy_provider_unregister(struct device *dev, | 
|  | 902 | struct phy_provider *phy_provider) { | 
|  | 903 | int r; | 
|  | 904 |  | 
|  | 905 | r = devres_destroy(dev, devm_phy_provider_release, devm_phy_match, | 
|  | 906 | phy_provider); | 
|  | 907 | dev_WARN_ONCE(dev, r, "couldn't find PHY provider device resource\n"); | 
|  | 908 | } | 
|  | 909 | EXPORT_SYMBOL_GPL(devm_of_phy_provider_unregister); | 
|  | 910 |  | 
|  | 911 | /** | 
|  | 912 | * phy_release() - release the phy | 
|  | 913 | * @dev: the dev member within phy | 
|  | 914 | * | 
|  | 915 | * When the last reference to the device is removed, it is called | 
|  | 916 | * from the embedded kobject as release method. | 
|  | 917 | */ | 
|  | 918 | static void phy_release(struct device *dev) | 
|  | 919 | { | 
|  | 920 | struct phy *phy; | 
|  | 921 |  | 
|  | 922 | phy = to_phy(dev); | 
|  | 923 | dev_vdbg(dev, "releasing '%s'\n", dev_name(dev)); | 
| Roger Quadros | 3be8812 | 2014-07-04 12:55:45 +0300 | [diff] [blame] | 924 | regulator_put(phy->pwr); | 
| Roger Quadros | e73b49f | 2014-07-10 11:55:02 +0530 | [diff] [blame] | 925 | ida_simple_remove(&phy_ida, phy->id); | 
| Kishon Vijay Abraham I | ff76496 | 2013-09-27 11:53:25 +0530 | [diff] [blame] | 926 | kfree(phy); | 
|  | 927 | } | 
|  | 928 |  | 
|  | 929 | static int __init phy_core_init(void) | 
|  | 930 | { | 
|  | 931 | phy_class = class_create(THIS_MODULE, "phy"); | 
|  | 932 | if (IS_ERR(phy_class)) { | 
|  | 933 | pr_err("failed to create phy class --> %ld\n", | 
|  | 934 | PTR_ERR(phy_class)); | 
|  | 935 | return PTR_ERR(phy_class); | 
|  | 936 | } | 
|  | 937 |  | 
|  | 938 | phy_class->dev_release = phy_release; | 
|  | 939 |  | 
|  | 940 | return 0; | 
|  | 941 | } | 
|  | 942 | module_init(phy_core_init); | 
|  | 943 |  | 
|  | 944 | static void __exit phy_core_exit(void) | 
|  | 945 | { | 
|  | 946 | class_destroy(phy_class); | 
|  | 947 | } | 
|  | 948 | module_exit(phy_core_exit); | 
|  | 949 |  | 
|  | 950 | MODULE_DESCRIPTION("Generic PHY Framework"); | 
|  | 951 | MODULE_AUTHOR("Kishon Vijay Abraham I <kishon@ti.com>"); | 
|  | 952 | MODULE_LICENSE("GPL v2"); |