1/*-
2 * Copyright (c) 2014 Ian Lepore <ian@freebsd.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 * $FreeBSD$
27 */
28
29#include <sys/cdefs.h>
30#include <sys/param.h>
31
32#include <dev/ofw/ofw_bus.h>
33#include <dev/ofw/ofw_bus_subr.h>
34
35#include "fdt_pinctrl_if.h"
36
37#include <dev/fdt/fdt_common.h>
38#include <dev/fdt/fdt_pinctrl.h>
39
40int
41fdt_pinctrl_configure(device_t client, u_int index)
42{
43	device_t pinctrl;
44	phandle_t *configs;
45	int i, nconfigs;
46	char name[16];
47
48	snprintf(name, sizeof(name), "pinctrl-%u", index);
49	nconfigs = OF_getencprop_alloc(ofw_bus_get_node(client), name,
50	    sizeof(*configs), (void **)&configs);
51	if (nconfigs < 0)
52		return (ENOENT);
53	if (nconfigs == 0)
54		return (0); /* Empty property is documented as valid. */
55	for (i = 0; i < nconfigs; i++) {
56		if ((pinctrl = OF_device_from_xref(configs[i])) != NULL)
57			FDT_PINCTRL_CONFIGURE(pinctrl, configs[i]);
58	}
59	free(configs, M_OFWPROP);
60	return (0);
61}
62
63int
64fdt_pinctrl_configure_by_name(device_t client, const char * name)
65{
66	char * names;
67	int i, offset, nameslen;
68
69	nameslen = OF_getprop_alloc(ofw_bus_get_node(client), "pinctrl-names",
70	    sizeof(*names), (void **)&names);
71	if (nameslen <= 0)
72		return (ENOENT);
73	for (i = 0, offset = 0; offset < nameslen; i++) {
74		if (strcmp(name, &names[offset]) == 0)
75			break;
76		offset += strlen(&names[offset]) + 1;
77	}
78	free(names, M_OFWPROP);
79	if (offset < nameslen)
80		return (fdt_pinctrl_configure(client, i));
81	else
82		return (ENOENT);
83}
84
85static int
86pinctrl_register_children(device_t pinctrl, phandle_t parent,
87    const char *pinprop)
88{
89	phandle_t node;
90
91	/*
92	 * Recursively descend from parent, looking for nodes that have the
93	 * given property, and associate the pinctrl device_t with each one.
94	 */
95	for (node = OF_child(parent); node != 0; node = OF_peer(node)) {
96		pinctrl_register_children(pinctrl, node, pinprop);
97		if (pinprop == NULL || OF_hasprop(node, pinprop)) {
98			OF_device_register_xref(OF_xref_from_node(node),
99			    pinctrl);
100		}
101	}
102	return (0);
103}
104
105int
106fdt_pinctrl_register(device_t pinctrl, const char *pinprop)
107{
108	phandle_t node;
109
110	node = ofw_bus_get_node(pinctrl);
111	OF_device_register_xref(OF_xref_from_node(node), pinctrl);
112	return (pinctrl_register_children(pinctrl, node, pinprop));
113}
114
115static int
116pinctrl_configure_children(device_t pinctrl, phandle_t parent)
117{
118	phandle_t node, *configs;
119	int i, nconfigs;
120
121	for (node = OF_child(parent); node != 0; node = OF_peer(node)) {
122		if (!fdt_is_enabled(node))
123			continue;
124		pinctrl_configure_children(pinctrl, node);
125		nconfigs = OF_getencprop_alloc(node, "pinctrl-0",
126		    sizeof(*configs), (void **)&configs);
127		if (nconfigs <= 0)
128			continue;
129		if (bootverbose) {
130			char name[32];
131			OF_getprop(node, "name", &name, sizeof(name));
132			printf("Processing %d pin-config node(s) in pinctrl-0 for %s\n",
133			    nconfigs, name);
134		}
135		for (i = 0; i < nconfigs; i++) {
136			if (OF_device_from_xref(configs[i]) == pinctrl)
137				FDT_PINCTRL_CONFIGURE(pinctrl, configs[i]);
138		}
139		free(configs, M_OFWPROP);
140	}
141	return (0);
142}
143
144int
145fdt_pinctrl_configure_tree(device_t pinctrl)
146{
147
148	return (pinctrl_configure_children(pinctrl, OF_peer(0)));
149}
150
151