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
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		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		}
124next:
125		resid -= (phy_cells + 1) * 4;
126		p += phy_cells + 1;
127	}
128
129done:
130	if (phys)
131		kmem_free(phys, len);
132
133	return phy;
134}
135
136struct fdtbus_phy *
137fdtbus_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
149void
150fdtbus_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
158device_t
159fdtbus_phy_device(struct fdtbus_phy *phy)
160{
161	return phy->phy_pc->pc_dev;
162}
163
164int
165fdtbus_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