xref: /openbsd-src/sys/dev/ofw/ofw_pinctrl.c (revision a77024392229412bd0851d9586f3ce1e52321555)

/*	$OpenBSD: ofw_pinctrl.c,v 1.3 2020/06/06 16:59:43 patrick Exp $	*/
/*
 * Copyright (c) 2016 Mark Kettenis
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <sys/types.h>
#include <sys/systm.h>
#include <sys/malloc.h>

#include <dev/ofw/openfirm.h>
#include <dev/ofw/ofw_pinctrl.h>

struct pinctrl {
	int	pc_phandle;
	int	(*pc_pinctrl)(uint32_t, void *);
	void	*pc_cookie;

	LIST_ENTRY(pinctrl) pc_list;
};

void pinctrl_register_child(int, int (*)(uint32_t, void *), void *);

LIST_HEAD(, pinctrl) pinctrls = LIST_HEAD_INITIALIZER(pinctrl);

void
pinctrl_register(int node, int (*pinctrl)(uint32_t, void *), void *cookie)
{
	for (node = OF_child(node); node; node = OF_peer(node))
		pinctrl_register_child(node, pinctrl, cookie);
}

void
pinctrl_register_child(int node, int (*pinctrl)(uint32_t, void *), void *cookie)
{
	struct pinctrl *pc;
	uint32_t phandle;

	phandle = OF_getpropint(node, "phandle", 0);
	if (phandle) {
		pc = malloc(sizeof(struct pinctrl), M_DEVBUF, M_WAITOK);
		pc->pc_phandle = phandle;
		pc->pc_pinctrl = pinctrl;
		pc->pc_cookie = cookie;
		LIST_INSERT_HEAD(&pinctrls, pc, pc_list);
	}

	for (node = OF_child(node); node; node = OF_peer(node))
		pinctrl_register_child(node, pinctrl, cookie);
}

int
pinctrl_byphandle(uint32_t phandle)
{
	struct pinctrl *pc;

	if (phandle == 0)
		return -1;

	LIST_FOREACH(pc, &pinctrls, pc_list) {
		if (pc->pc_phandle == phandle)
			return pc->pc_pinctrl(pc->pc_phandle, pc->pc_cookie);
	}

	return -1;
}

int
pinctrl_byid(int node, int id)
{
	char pinctrl[32];
	uint32_t *phandles;
	int len, i;

	snprintf(pinctrl, sizeof(pinctrl), "pinctrl-%d", id);
	len = OF_getproplen(node, pinctrl);
	if (len <= 0)
		return -1;

	phandles = malloc(len, M_TEMP, M_WAITOK);
	OF_getpropintarray(node, pinctrl, phandles, len);
	for (i = 0; i < len / sizeof(uint32_t); i++)
		pinctrl_byphandle(phandles[i]);
	free(phandles, M_TEMP, len);
	return 0;
}

int
pinctrl_byname(int node, const char *config)
{
	int id;

	id = OF_getindex(node, config, "pinctrl-names");
	if (id < 0)
		return -1;

	return pinctrl_byid(node, id);
}