fdt_phy.c revision 1.4 
1/* $NetBSD: fdt_phy.c,v 1.4 2019/02/27 16:30:40 jakllsch 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.4 2019/02/27 16:30:40 jakllsch 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
40struct 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
48static LIST_HEAD(, fdtbus_phy_controller) fdtbus_phy_controllers =
49    LIST_HEAD_INITIALIZER(fdtbus_phy_controllers);
50
51int
52fdtbus_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
67static struct fdtbus_phy_controller *
68fdtbus_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
80struct fdtbus_phy *
81fdtbus_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		const int pc_phandle =
104		    fdtbus_get_phandle_from_native(be32toh(p[0]));
105		if (of_getprop_uint32(pc_phandle, "#phy-cells", &phy_cells))
106			break;
107		if (n == index) {
108			pc = fdtbus_get_phy_controller(pc_phandle);
109			if (pc == NULL)
110				goto done;
111			phy_priv = pc->pc_funcs->acquire(pc->pc_dev,
112			    phy_cells > 0 ? &p[1] : NULL, phy_cells * 4);
113			if (phy_priv) {
114				phy = kmem_alloc(sizeof(*phy), KM_SLEEP);
115				phy->phy_pc = pc;
116				phy->phy_priv = phy_priv;
117			}
118			break;
119		}
120		resid -= (phy_cells + 1) * 4;
121		p += phy_cells + 1;
122	}
123
124done:
125	if (phys)
126		kmem_free(phys, len);
127
128	return phy;
129}
130
131struct fdtbus_phy *
132fdtbus_phy_get(int phandle, const char *phyname)
133{
134	struct fdtbus_phy *phy = NULL;
135	char *phy_names = NULL;
136	const char *p;
137	u_int index;
138	int len, resid;
139
140	len = OF_getproplen(phandle, "phy-names");
141	if (len <= 0)
142		return NULL;
143
144	phy_names = kmem_alloc(len, KM_SLEEP);
145	if (OF_getprop(phandle, "phy-names", phy_names, len) != len) {
146		kmem_free(phy_names, len);
147		return NULL;
148	}
149
150	p = phy_names;
151	for (index = 0, resid = len; resid > 0; index++) {
152		if (strcmp(p, phyname) == 0) {
153			phy = fdtbus_phy_get_index(phandle, index);
154			break;
155		}
156		resid -= strlen(p) + 1;
157		p += strlen(p) + 1;
158	}
159
160	if (phy_names)
161		kmem_free(phy_names, len);
162
163	return phy;
164}
165
166void
167fdtbus_phy_put(struct fdtbus_phy *phy)
168{
169	struct fdtbus_phy_controller *pc = phy->phy_pc;
170
171	pc->pc_funcs->release(pc->pc_dev, phy->phy_priv);
172	kmem_free(phy, sizeof(*phy));
173}
174
175device_t
176fdtbus_phy_device(struct fdtbus_phy *phy)
177{
178	return phy->phy_pc->pc_dev;
179}
180
181int
182fdtbus_phy_enable(struct fdtbus_phy *phy, bool enable)
183{
184	struct fdtbus_phy_controller *pc = phy->phy_pc;
185
186	return pc->pc_funcs->enable(pc->pc_dev, phy->phy_priv, enable);
187}
188