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