1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2017 Texas Instruments Incorporated - http://www.ti.com/
4 * Written by Jean-Jacques Hiblot <jjhiblot@ti.com>
5 */
6
7 #include <common.h>
8 #include <dm.h>
9 #include <generic-phy.h>
10
phy_dev_ops(struct udevice * dev)11 static inline struct phy_ops *phy_dev_ops(struct udevice *dev)
12 {
13 return (struct phy_ops *)dev->driver->ops;
14 }
15
generic_phy_xlate_offs_flags(struct phy * phy,struct ofnode_phandle_args * args)16 static int generic_phy_xlate_offs_flags(struct phy *phy,
17 struct ofnode_phandle_args *args)
18 {
19 debug("%s(phy=%p)\n", __func__, phy);
20
21 if (args->args_count > 1) {
22 debug("Invaild args_count: %d\n", args->args_count);
23 return -EINVAL;
24 }
25
26 if (args->args_count)
27 phy->id = args->args[0];
28 else
29 phy->id = 0;
30
31 return 0;
32 }
33
generic_phy_get_by_index(struct udevice * dev,int index,struct phy * phy)34 int generic_phy_get_by_index(struct udevice *dev, int index,
35 struct phy *phy)
36 {
37 struct ofnode_phandle_args args;
38 struct phy_ops *ops;
39 struct udevice *phydev;
40 int i, ret;
41
42 debug("%s(dev=%p, index=%d, phy=%p)\n", __func__, dev, index, phy);
43
44 assert(phy);
45 phy->dev = NULL;
46 ret = dev_read_phandle_with_args(dev, "phys", "#phy-cells", 0, index,
47 &args);
48 if (ret) {
49 debug("%s: dev_read_phandle_with_args failed: err=%d\n",
50 __func__, ret);
51 return ret;
52 }
53
54 ret = uclass_get_device_by_ofnode(UCLASS_PHY, args.node, &phydev);
55 if (ret) {
56 debug("%s: uclass_get_device_by_ofnode failed: err=%d\n",
57 __func__, ret);
58
59 /* Check if args.node's parent is a PHY provider */
60 ret = uclass_get_device_by_ofnode(UCLASS_PHY,
61 ofnode_get_parent(args.node),
62 &phydev);
63 if (ret)
64 return ret;
65
66 /* insert phy idx at first position into args array */
67 for (i = args.args_count; i >= 1 ; i--)
68 args.args[i] = args.args[i - 1];
69
70 args.args_count++;
71 args.args[0] = ofnode_read_u32_default(args.node, "reg", -1);
72 }
73
74 phy->dev = phydev;
75
76 ops = phy_dev_ops(phydev);
77
78 if (ops->of_xlate)
79 ret = ops->of_xlate(phy, &args);
80 else
81 ret = generic_phy_xlate_offs_flags(phy, &args);
82 if (ret) {
83 debug("of_xlate() failed: %d\n", ret);
84 goto err;
85 }
86
87 return 0;
88
89 err:
90 return ret;
91 }
92
generic_phy_get_by_name(struct udevice * dev,const char * phy_name,struct phy * phy)93 int generic_phy_get_by_name(struct udevice *dev, const char *phy_name,
94 struct phy *phy)
95 {
96 int index;
97
98 debug("%s(dev=%p, name=%s, phy=%p)\n", __func__, dev, phy_name, phy);
99
100 index = dev_read_stringlist_search(dev, "phy-names", phy_name);
101 if (index < 0) {
102 debug("dev_read_stringlist_search() failed: %d\n", index);
103 return index;
104 }
105
106 return generic_phy_get_by_index(dev, index, phy);
107 }
108
generic_phy_init(struct phy * phy)109 int generic_phy_init(struct phy *phy)
110 {
111 struct phy_ops const *ops = phy_dev_ops(phy->dev);
112
113 return ops->init ? ops->init(phy) : 0;
114 }
115
generic_phy_reset(struct phy * phy)116 int generic_phy_reset(struct phy *phy)
117 {
118 struct phy_ops const *ops = phy_dev_ops(phy->dev);
119
120 return ops->reset ? ops->reset(phy) : 0;
121 }
122
generic_phy_exit(struct phy * phy)123 int generic_phy_exit(struct phy *phy)
124 {
125 struct phy_ops const *ops = phy_dev_ops(phy->dev);
126
127 return ops->exit ? ops->exit(phy) : 0;
128 }
129
generic_phy_power_on(struct phy * phy)130 int generic_phy_power_on(struct phy *phy)
131 {
132 struct phy_ops const *ops = phy_dev_ops(phy->dev);
133
134 return ops->power_on ? ops->power_on(phy) : 0;
135 }
136
generic_phy_power_off(struct phy * phy)137 int generic_phy_power_off(struct phy *phy)
138 {
139 struct phy_ops const *ops = phy_dev_ops(phy->dev);
140
141 return ops->power_off ? ops->power_off(phy) : 0;
142 }
143
144 UCLASS_DRIVER(phy) = {
145 .id = UCLASS_PHY,
146 .name = "phy",
147 };
148