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