board/radxa/zero3-rk3566/zero3-rk3566.c

// SPDX-License-Identifier: GPL-2.0+

#include <linux/errno.h>
#include <linux/kernel.h>
#include <adc.h>
#include <env.h>

#define HW_ID_CHANNEL	1

struct board_model {
	unsigned int low;
	unsigned int high;
	const char *fdtfile;
};

static const struct board_model board_models[] = {
	{ 230, 270, "rockchip/rk3566-radxa-zero-3w.dtb" },
	{ 400, 450, "rockchip/rk3566-radxa-zero-3e.dtb" },
};

static const struct board_model *get_board_model(void)
{
	unsigned int val;
	int i, ret;

	ret = adc_channel_single_shot("saradc@fe720000", HW_ID_CHANNEL, &val);
	if (ret)
		return NULL;

	for (i = 0; i < ARRAY_SIZE(board_models); i++) {
		unsigned int min = board_models[i].low;
		unsigned int max = board_models[i].high;

		if (min <= val && val <= max)
			return &board_models[i];
	}

	return NULL;
}

int rk_board_late_init(void)
{
	const struct board_model *model = get_board_model();

	if (model)
		env_set("fdtfile", model->fdtfile);

	return 0;
}

int board_fit_config_name_match(const char *name)
{
	const struct board_model *model = get_board_model();

	if (model && !strcmp(name, model->fdtfile))
		return 0;

	return -EINVAL;
}