forked from Mirrors/opensbi
df1c100001
This allows the compiler to generate significantly better code, because it does not have to maintain either the loop counter or loop limit. Plus there are half as many symbols to relocate. This also simplifies passing carray arrays to helper functions. Signed-off-by: Samuel Holland <samuel.holland@sifive.com> Reviewed-by: Anup Patel <anup@brainfault.org>
86 lines
1.7 KiB
C
86 lines
1.7 KiB
C
/*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2021 YADRO
|
|
*
|
|
* Authors:
|
|
* Nikita Shubin <n.shubin@yadro.com>
|
|
*
|
|
* derivate: lib/utils/gpio/fdt_gpio.c
|
|
* Authors:
|
|
* Anup Patel <anup.patel@wdc.com>
|
|
*/
|
|
|
|
#include <libfdt.h>
|
|
#include <sbi/sbi_error.h>
|
|
#include <sbi_utils/fdt/fdt_helper.h>
|
|
#include <sbi_utils/i2c/fdt_i2c.h>
|
|
|
|
/* List of FDT i2c adapter drivers generated at compile time */
|
|
extern struct fdt_i2c_adapter *const fdt_i2c_adapter_drivers[];
|
|
|
|
static int fdt_i2c_adapter_init(const void *fdt, int nodeoff)
|
|
{
|
|
int pos, rc;
|
|
struct fdt_i2c_adapter *drv;
|
|
const struct fdt_match *match;
|
|
|
|
/* Try all I2C drivers one-by-one */
|
|
for (pos = 0; fdt_i2c_adapter_drivers[pos]; pos++) {
|
|
drv = fdt_i2c_adapter_drivers[pos];
|
|
match = fdt_match_node(fdt, nodeoff, drv->match_table);
|
|
if (match && drv->init) {
|
|
rc = drv->init(fdt, nodeoff, match);
|
|
if (rc == SBI_ENODEV)
|
|
continue;
|
|
if (rc)
|
|
return rc;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return SBI_ENOSYS;
|
|
}
|
|
|
|
static int fdt_i2c_adapter_find(const void *fdt, int nodeoff,
|
|
struct i2c_adapter **out_adapter)
|
|
{
|
|
int rc;
|
|
struct i2c_adapter *adapter = i2c_adapter_find(nodeoff);
|
|
|
|
if (!adapter) {
|
|
/* I2C adapter not found so initialize matching driver */
|
|
rc = fdt_i2c_adapter_init(fdt, nodeoff);
|
|
if (rc)
|
|
return rc;
|
|
|
|
/* Try to find I2C adapter again */
|
|
adapter = i2c_adapter_find(nodeoff);
|
|
if (!adapter)
|
|
return SBI_ENOSYS;
|
|
}
|
|
|
|
if (out_adapter)
|
|
*out_adapter = adapter;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int fdt_i2c_adapter_get(const void *fdt, int nodeoff,
|
|
struct i2c_adapter **out_adapter)
|
|
{
|
|
int rc;
|
|
struct i2c_adapter *adapter;
|
|
|
|
if (!fdt || (nodeoff < 0) || !out_adapter)
|
|
return SBI_EINVAL;
|
|
|
|
rc = fdt_i2c_adapter_find(fdt, nodeoff, &adapter);
|
|
if (rc)
|
|
return rc;
|
|
|
|
*out_adapter = adapter;
|
|
|
|
return 0;
|
|
}
|