1 /* $NetBSD: fdt_phy.c,v 1.6 2019/10/30 21:37:36 jmcneill Exp $ */
2
3 /*-
4 * Copyright (c) 2015-2017 Jared McNeill <jmcneill@invisible.ca>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 __KERNEL_RCSID(0, "$NetBSD: fdt_phy.c,v 1.6 2019/10/30 21:37:36 jmcneill Exp $");
31
32 #include <sys/param.h>
33 #include <sys/bus.h>
34 #include <sys/kmem.h>
35 #include <sys/queue.h>
36
37 #include <libfdt.h>
38 #include <dev/fdt/fdtvar.h>
39
40 struct fdtbus_phy_controller {
41 device_t pc_dev;
42 int pc_phandle;
43 const struct fdtbus_phy_controller_func *pc_funcs;
44
45 LIST_ENTRY(fdtbus_phy_controller) pc_next;
46 };
47
48 static LIST_HEAD(, fdtbus_phy_controller) fdtbus_phy_controllers =
49 LIST_HEAD_INITIALIZER(fdtbus_phy_controllers);
50
51 int
fdtbus_register_phy_controller(device_t dev,int phandle,const struct fdtbus_phy_controller_func * funcs)52 fdtbus_register_phy_controller(device_t dev, int phandle,
53 const struct fdtbus_phy_controller_func *funcs)
54 {
55 struct fdtbus_phy_controller *pc;
56
57 pc = kmem_alloc(sizeof(*pc), KM_SLEEP);
58 pc->pc_dev = dev;
59 pc->pc_phandle = phandle;
60 pc->pc_funcs = funcs;
61
62 LIST_INSERT_HEAD(&fdtbus_phy_controllers, pc, pc_next);
63
64 return 0;
65 }
66
67 static struct fdtbus_phy_controller *
fdtbus_get_phy_controller(int phandle)68 fdtbus_get_phy_controller(int phandle)
69 {
70 struct fdtbus_phy_controller *pc;
71
72 LIST_FOREACH(pc, &fdtbus_phy_controllers, pc_next) {
73 if (pc->pc_phandle == phandle)
74 return pc;
75 }
76
77 return NULL;
78 }
79
80 struct fdtbus_phy *
fdtbus_phy_get_index(int phandle,u_int index)81 fdtbus_phy_get_index(int phandle, u_int index)
82 {
83 struct fdtbus_phy_controller *pc;
84 struct fdtbus_phy *phy = NULL;
85 void *phy_priv = NULL;
86 uint32_t *phys = NULL;
87 uint32_t *p;
88 u_int n, phy_cells;
89 int len, resid;
90
91 len = OF_getproplen(phandle, "phys");
92 if (len <= 0)
93 return NULL;
94
95 phys = kmem_alloc(len, KM_SLEEP);
96 if (OF_getprop(phandle, "phys", phys, len) != len) {
97 kmem_free(phys, len);
98 return NULL;
99 }
100
101 p = phys;
102 for (n = 0, resid = len; resid > 0; n++) {
103 if (p[0] == 0) {
104 phy_cells = 0;
105 goto next;
106 }
107 const int pc_phandle =
108 fdtbus_get_phandle_from_native(be32toh(p[0]));
109 if (of_getprop_uint32(pc_phandle, "#phy-cells", &phy_cells))
110 break;
111 if (n == index) {
112 pc = fdtbus_get_phy_controller(pc_phandle);
113 if (pc == NULL)
114 goto done;
115 phy_priv = pc->pc_funcs->acquire(pc->pc_dev,
116 phy_cells > 0 ? &p[1] : NULL, phy_cells * 4);
117 if (phy_priv) {
118 phy = kmem_alloc(sizeof(*phy), KM_SLEEP);
119 phy->phy_pc = pc;
120 phy->phy_priv = phy_priv;
121 }
122 break;
123 }
124 next:
125 resid -= (phy_cells + 1) * 4;
126 p += phy_cells + 1;
127 }
128
129 done:
130 if (phys)
131 kmem_free(phys, len);
132
133 return phy;
134 }
135
136 struct fdtbus_phy *
fdtbus_phy_get(int phandle,const char * phyname)137 fdtbus_phy_get(int phandle, const char *phyname)
138 {
139 u_int index;
140 int err;
141
142 err = fdtbus_get_index(phandle, "phy-names", phyname, &index);
143 if (err != 0)
144 return NULL;
145
146 return fdtbus_phy_get_index(phandle, index);
147 }
148
149 void
fdtbus_phy_put(struct fdtbus_phy * phy)150 fdtbus_phy_put(struct fdtbus_phy *phy)
151 {
152 struct fdtbus_phy_controller *pc = phy->phy_pc;
153
154 pc->pc_funcs->release(pc->pc_dev, phy->phy_priv);
155 kmem_free(phy, sizeof(*phy));
156 }
157
158 device_t
fdtbus_phy_device(struct fdtbus_phy * phy)159 fdtbus_phy_device(struct fdtbus_phy *phy)
160 {
161 return phy->phy_pc->pc_dev;
162 }
163
164 int
fdtbus_phy_enable(struct fdtbus_phy * phy,bool enable)165 fdtbus_phy_enable(struct fdtbus_phy *phy, bool enable)
166 {
167 struct fdtbus_phy_controller *pc = phy->phy_pc;
168
169 return pc->pc_funcs->enable(pc->pc_dev, phy->phy_priv, enable);
170 }
171