/* $NetBSD: ofw_i2c_subr.c,v 1.1 2021/02/04 20:19:09 thorpej Exp $ */
/*
* Copyright 1998
* Digital Equipment Corporation. All rights reserved.
*
* This software is furnished under license and may be used and
* copied only in accordance with the following terms and conditions.
* Subject to these conditions, you may download, copy, install,
* use, modify and distribute this software in source and/or binary
* form. No title or ownership is transferred hereby.
*
* 1) Any source code used, modified or distributed must reproduce
* and retain this copyright notice and list of conditions as
* they appear in the source file.
*
* 2) No right is granted to use any trade name, trademark, or logo of
* Digital Equipment Corporation. Neither the "Digital Equipment
* Corporation" name nor any trademark or logo of Digital Equipment
* Corporation may be used to endorse or promote products derived
* from this software without the prior written permission of
* Digital Equipment Corporation.
*
* 3) This software is provided "AS-IS" and any express or implied
* warranties, including but not limited to, any implied warranties
* of merchantability, fitness for a particular purpose, or
* non-infringement are disclaimed. In no event shall DIGITAL be
* liable for any damages whatsoever, and in particular, DIGITAL
* shall not be liable for special, indirect, consequential, or
* incidental damages or damages for lost profits, loss of
* revenue or loss of use, whether such damages arise in contract,
* negligence, tort, under statute, in equity, at law or otherwise,
* even if advised of the possibility of such damage.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ofw_i2c_subr.c,v 1.1 2021/02/04 20:19:09 thorpej Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/kmem.h>
#include <sys/systm.h>
#include <dev/ofw/openfirm.h>
#include <dev/i2c/i2cvar.h>
/*
* Iterate over the subtree of a i2c controller node.
* Add all sub-devices into an array as part of the controller's
* device properties.
* This is used by the i2c bus attach code to do direct configuration.
*/
void
of_enter_i2c_devs(prop_dictionary_t props, int ofnode, size_t cell_size,
int addr_shift)
{
int node, len;
char name[32];
uint64_t reg64;
uint32_t reg32;
uint64_t addr;
prop_array_t array = NULL;
prop_dictionary_t dev;
for (node = OF_child(ofnode); node; node = OF_peer(node)) {
if (OF_getprop(node, "name", name, sizeof(name)) <= 0)
continue;
len = OF_getproplen(node, "reg");
addr = 0;
if (cell_size == 8 && len >= sizeof(reg64)) {
if (OF_getprop(node, "reg", ®64, sizeof(reg64))
< sizeof(reg64))
continue;
addr = be64toh(reg64);
/*
* The i2c bus number (0 or 1) is encoded in bit 33
* of the register, but we encode it in bit 8 of
* i2c_addr_t.
*/
if (addr & 0x100000000)
addr = (addr & 0xff) | 0x100;
} else if (cell_size == 4 && len >= sizeof(reg32)) {
if (OF_getprop(node, "reg", ®32, sizeof(reg32))
< sizeof(reg32))
continue;
addr = be32toh(reg32);
} else {
continue;
}
addr >>= addr_shift;
if (addr == 0) continue;
if (array == NULL)
array = prop_array_create();
dev = prop_dictionary_create();
prop_dictionary_set_string(dev, "name", name);
prop_dictionary_set_uint32(dev, "addr", addr);
prop_dictionary_set_uint64(dev, "cookie", node);
prop_dictionary_set_uint32(dev, "cookietype", I2C_COOKIE_OF);
of_to_dataprop(dev, node, "compatible", "compatible");
prop_array_add(array, dev);
prop_object_release(dev);
}
if (array != NULL) {
prop_dictionary_set(props, "i2c-child-devices", array);
prop_object_release(array);
}
}