src/soc/mediatek/mt8195/mt6360.c

/* SPDX-License-Identifier: GPL-2.0-only */

#include <console/console.h>
#include <device/i2c_simple.h>
#include <soc/mt6360.h>
#include <stdbool.h>
#include <string.h>

static struct mt6360_i2c_data i2c_data[] = {
	[MT6360_INDEX_LDO] = {
		.addr = MT6360_LDO_I2C_ADDR,
	},
	[MT6360_INDEX_PMIC] = {
		.addr = MT6360_PMIC_I2C_ADDR,
	},
};

static const uint32_t mt6360_ldo1_vsel_table[0x10] = {
	[0x4] = 1800000,
	[0x5] = 2000000,
	[0x6] = 2100000,
	[0x7] = 2500000,
	[0x8] = 2700000,
	[0x9] = 2800000,
	[0xA] = 2900000,
	[0xB] = 3000000,
	[0xC] = 3100000,
	[0xD] = 3300000,
};

static const uint32_t mt6360_ldo3_vsel_table[0x10] = {
	[0x4] = 1800000,
	[0xA] = 2900000,
	[0xB] = 3000000,
	[0xD] = 3300000,
};

static const uint32_t mt6360_ldo5_vsel_table[0x10] = {
	[0x2] = 2900000,
	[0x3] = 3000000,
	[0x5] = 3300000,
};

static const struct mt6360_data regulator_data[MT6360_REGULATOR_COUNT] = {
	[MT6360_LDO3]  = MT6360_DATA(0x05, 0x40, 0x09, 0xff, mt6360_ldo3_vsel_table),
	[MT6360_LDO5]  = MT6360_DATA(0x0b, 0x40, 0x0f, 0xff, mt6360_ldo5_vsel_table),
	[MT6360_LDO6]  = MT6360_DATA(0x37, 0x40, 0x3b, 0xff, mt6360_ldo3_vsel_table),
	[MT6360_LDO7]  = MT6360_DATA(0x31, 0x40, 0x35, 0xff, mt6360_ldo5_vsel_table),
	[MT6360_BUCK1] = MT6360_DATA(0x17, 0x40, 0x10, 0xff, mt6360_ldo1_vsel_table),
	[MT6360_BUCK2] = MT6360_DATA(0x27, 0x40, 0x20, 0xff, mt6360_ldo1_vsel_table),
	[MT6360_LDO1]  = MT6360_DATA(0x17, 0x40, 0x1b, 0xff, mt6360_ldo1_vsel_table),
	[MT6360_LDO2]  = MT6360_DATA(0x11, 0x40, 0x15, 0xff, mt6360_ldo1_vsel_table),
};

#define CRC8_TABLE_SIZE 256
static u8 crc8_table[MT6360_INDEX_COUNT][CRC8_TABLE_SIZE];

static u8 crc8(const u8 table[CRC8_TABLE_SIZE], u8 *pdata, size_t nbytes)
{
	u8 crc = 0;

	while (nbytes-- > 0)
		crc = table[(crc ^ *pdata++) & 0xff];

	return crc;
}

static void crc8_populate_msb(u8 table[CRC8_TABLE_SIZE], u8 polynomial)
{
	int i, j;
	const u8 msbit = 0x80;
	u8 t = msbit;

	table[0] = 0;

	for (i = 1; i < CRC8_TABLE_SIZE; i *= 2) {
		t = (t << 1) ^ (t & msbit ? polynomial : 0);
		for (j = 0; j < i; j++)
			table[i + j] = table[j] ^ t;
	}
}

static int mt6360_i2c_write_byte(u8 index, u8 reg, u8 data)
{
	u8 chunk[5] = { 0 };
	struct mt6360_i2c_data *i2c = &i2c_data[index];

	if ((reg & 0xc0) != 0) {
		printk(BIOS_ERR, "%s: not support reg [%#x]\n", __func__, reg);
		return -1;
	}

	/*
	 * chunk[0], dev address
	 * chunk[1], reg address
	 * chunk[2], data to write
	 * chunk[3], crc of chunk[0 ~ 2]
	 * chunk[4], blank
	 */
	chunk[0] = (i2c->addr & 0x7f) << 1;
	chunk[1] = (reg & 0x3f);
	chunk[2] = data;
	chunk[3] = crc8(crc8_table[index], chunk, 3);

	return i2c_write_raw(i2c->bus, i2c->addr, &chunk[1], 4);
}

static int mt6360_i2c_read_byte(u8 index, u8 reg, u8 *data)
{
	u8 chunk[4] = { 0 };
	u8 buf[2];
	int ret;
	u8 crc;
	struct mt6360_i2c_data *i2c = &i2c_data[index];

	ret = i2c_read_bytes(i2c->bus, i2c->addr, reg & 0x3f, buf, 2);

	if (ret)
		return ret;
	/*
	 * chunk[0], dev address
	 * chunk[1], reg address
	 * chunk[2], received data
	 * chunk[3], received crc of chunk[0 ~ 2]
	 */
	chunk[0] = ((i2c->addr & 0x7f) << 1) + 1;
	chunk[1] = (reg & 0x3f);
	chunk[2] = buf[0];
	chunk[3] = buf[1];
	crc = crc8(crc8_table[index], chunk, 3);

	if (chunk[3] != crc) {
		printk(BIOS_ERR, "%s: incorrect CRC: expected %#x, got %#x",
		       __func__, crc, chunk[3]);
		return -1;
	}

	*data = chunk[2];

	return 0;
}

static int mt6360_read_interface(u8 index, u8 reg, u8 *data, u8 mask, u8 shift)
{
	int ret;
	u8 val = 0;

	ret = mt6360_i2c_read_byte(index, reg, &val);
	if (ret < 0) {
		printk(BIOS_ERR, "%s: fail, reg = %#x, ret = %d\n",
		       __func__, reg, ret);
		return ret;
	}
	val &= (mask << shift);
	*data = (val >> shift);
	return 0;
}

static int mt6360_config_interface(u8 index, u8 reg, u8 data, u8 mask, u8 shift)
{
	int ret;
	u8 val = 0;

	ret = mt6360_i2c_read_byte(index, reg, &val);
	if (ret < 0) {
		printk(BIOS_ERR, "%s: fail, reg = %#x, ret = %d\n",
		       __func__, reg, ret);
		return ret;
	}
	val &= ~(mask << shift);
	val |= (data << shift);

	return mt6360_i2c_write_byte(index, reg, val);
}

static bool is_valid_ldo(enum mt6360_regulator_id id)
{
	if (id != MT6360_LDO1 && id != MT6360_LDO2 &&
	    id != MT6360_LDO3 && id != MT6360_LDO5) {
		printk(BIOS_ERR, "%s: LDO %d is not supported\n", __func__, id);
		return false;
	}

	return true;
}

static bool is_valid_pmic(enum mt6360_regulator_id id)
{
	if (id != MT6360_LDO6 && id != MT6360_LDO7 &&
	    id != MT6360_BUCK1 && id != MT6360_BUCK2) {
		printk(BIOS_ERR, "%s: PMIC %d is not supported\n", __func__, id);
		return false;
	}

	return true;
}

static void mt6360_ldo_enable(enum mt6360_regulator_id id, uint8_t enable)
{
	u8 val;
	const struct mt6360_data *data;

	if (!is_valid_ldo(id))
		return;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_LDO, data->enable_reg, &val, 0xff, 0) < 0)
		return;

	if (enable)
		val |= data->enable_mask;
	else
		val &= ~(data->enable_mask);

	mt6360_config_interface(MT6360_INDEX_LDO, data->enable_reg, val, 0xff, 0);
}

static uint8_t mt6360_ldo_is_enabled(enum mt6360_regulator_id id)
{
	u8 val;
	const struct mt6360_data *data;

	if (!is_valid_ldo(id))
		return 0;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_LDO, data->enable_reg, &val, 0xff, 0) < 0)
		return 0;

	return (val & data->enable_mask) ? 1 : 0;
}

static void mt6360_ldo_set_voltage(enum mt6360_regulator_id id, u32 voltage_uv)
{
	u8 val = 0;
	u32 voltage_uv_temp = 0;
	int i;

	const struct mt6360_data *data;

	if (!is_valid_ldo(id))
		return;

	data = &regulator_data[id];

	for (i = 0; i < data->vsel_table_len; i++) {
		u32 uv = data->vsel_table[i];

		if (uv == 0)
			continue;
		if (uv > voltage_uv)
			break;

		val = i << 4;
		voltage_uv_temp = voltage_uv - uv;
	}

	if (val == 0) {
		printk(BIOS_ERR, "%s: LDO %d, set %d uV not supported\n",
		       __func__, id, voltage_uv);
		return;
	}

	voltage_uv_temp /= 10000;
	voltage_uv_temp = MIN(voltage_uv_temp, 0xa);
	val |= (u8)voltage_uv_temp;

	mt6360_config_interface(MT6360_INDEX_LDO, data->vsel_reg, val, 0xff, 0);
}

static u32 mt6360_ldo_get_voltage(enum mt6360_regulator_id id)
{
	u8 val;
	u32 voltage_uv;

	const struct mt6360_data *data;

	if (!is_valid_ldo(id))
		return 0;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_LDO, data->vsel_reg, &val, 0xff, 0) < 0)
		return 0;

	voltage_uv = data->vsel_table[(val & 0xf0) >> 4];
	if (voltage_uv == 0) {
		printk(BIOS_ERR, "%s: LDO %d read fail, reg = %#x\n", __func__, id, val);
		return 0;
	}

	val = MIN(val & 0x0f, 0x0a);
	voltage_uv += val * 10000;

	return voltage_uv;
}

static void mt6360_pmic_enable(enum mt6360_regulator_id id, uint8_t enable)
{
	u8 val;
	const struct mt6360_data *data;

	if (!is_valid_pmic(id))
		return;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_PMIC, data->enable_reg, &val, 0xff, 0) < 0)
		return;

	if (enable)
		val |= data->enable_mask;
	else
		val &= ~(data->enable_mask);

	mt6360_config_interface(MT6360_INDEX_PMIC, data->enable_reg, val, 0xff, 0);
}

static uint8_t mt6360_pmic_is_enabled(enum mt6360_regulator_id id)
{
	u8 val;
	const struct mt6360_data *data;

	if (!is_valid_pmic(id))
		return 0;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_PMIC, data->enable_reg, &val, 0xff, 0) < 0)
		return 0;

	return (val & data->enable_mask) ? 1 : 0;
}

static void mt6360_pmic_set_voltage(enum mt6360_regulator_id id, u32 voltage_uv)
{
	u8 val = 0;

	const struct mt6360_data *data;

	if (!is_valid_pmic(id))
		return;

	data = &regulator_data[id];

	if (id == MT6360_BUCK1 || id == MT6360_BUCK2) {
		val = (voltage_uv - 300000) / 5000;
	} else if (id == MT6360_LDO6 || id == MT6360_LDO7) {
		val = (((voltage_uv - 500000) / 100000) << 4);
		val += (((voltage_uv - 500000) % 100000) / 10000);
	}

	mt6360_config_interface(MT6360_INDEX_PMIC, data->vsel_reg, val, 0xff, 0);
}

static u32 mt6360_pmic_get_voltage(enum mt6360_regulator_id id)
{
	u8 val;
	u32 voltage_uv = 0;

	const struct mt6360_data *data;

	if (!is_valid_pmic(id))
		return 0;

	data = &regulator_data[id];

	if (mt6360_read_interface(MT6360_INDEX_PMIC, data->vsel_reg, &val, 0xff, 0) < 0)
		return 0;

	if (id == MT6360_BUCK1 || id == MT6360_BUCK2) {
		voltage_uv = 300000 + val * 5000;
	} else if (id == MT6360_LDO6 || id == MT6360_LDO7) {
		voltage_uv = 500000 + 100000 * (val >> 4);
		voltage_uv += MIN(val & 0xf, 0xa) * 10000;
	}

	return voltage_uv;
}

void mt6360_init(uint8_t bus)
{
	u8 delay01, delay02, delay03, delay04;

	crc8_populate_msb(crc8_table[MT6360_INDEX_LDO], 0x7);
	crc8_populate_msb(crc8_table[MT6360_INDEX_PMIC], 0x7);

	i2c_data[MT6360_INDEX_LDO].bus = bus;
	i2c_data[MT6360_INDEX_PMIC].bus = bus;

	mt6360_config_interface(MT6360_INDEX_PMIC, 0x07, 0x04, 0xff, 0);
	mt6360_config_interface(MT6360_INDEX_PMIC, 0x08, 0x00, 0xff, 0);
	mt6360_config_interface(MT6360_INDEX_PMIC, 0x09, 0x02, 0xff, 0);
	mt6360_config_interface(MT6360_INDEX_PMIC, 0x0a, 0x00, 0xff, 0);

	mt6360_read_interface(MT6360_INDEX_PMIC, 0x07, &delay01, 0xff, 0);
	mt6360_read_interface(MT6360_INDEX_PMIC, 0x08, &delay02, 0xff, 0);
	mt6360_read_interface(MT6360_INDEX_PMIC, 0x09, &delay03, 0xff, 0);
	mt6360_read_interface(MT6360_INDEX_PMIC, 0x0a, &delay04, 0xff, 0);
	printk(BIOS_DEBUG,
	       "%s: power off sequence delay: %#x, %#x, %#x, %#x\n",
	       __func__, delay01, delay02, delay03, delay04);
}

void mt6360_enable(enum mt6360_regulator_id id, uint8_t enable)
{
	if (is_valid_ldo(id))
		mt6360_ldo_enable(id, enable);
	else if (is_valid_pmic(id))
		mt6360_pmic_enable(id, enable);
}

uint8_t mt6360_is_enabled(enum mt6360_regulator_id id)
{
	if (is_valid_ldo(id))
		return mt6360_ldo_is_enabled(id);
	else if (is_valid_pmic(id))
		return mt6360_pmic_is_enabled(id);
	else
		return 0;
}

void mt6360_set_voltage(enum mt6360_regulator_id id, u32 voltage_uv)
{
	if (is_valid_ldo(id))
		mt6360_ldo_set_voltage(id, voltage_uv);
	else if (is_valid_pmic(id))
		mt6360_pmic_set_voltage(id, voltage_uv);
}

u32 mt6360_get_voltage(enum mt6360_regulator_id id)
{
	if (is_valid_ldo(id))
		return mt6360_ldo_get_voltage(id);
	else if (is_valid_pmic(id))
		return mt6360_pmic_get_voltage(id);
	else
		return 0;
}