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