^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2016-2017 Texas Instruments Incorporated - https://www.ti.com/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Nishanth Menon <nm@ti.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Dave Gerlach <d-gerlach@ti.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * TI OPP supply driver that provides override into the regulator control
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * for generic opp core to handle devices with ABB regulator and/or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * SmartReflex Class0.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/clk.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/cpufreq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/notifier.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/pm_opp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/regulator/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) * struct ti_opp_supply_optimum_voltage_table - optimized voltage table
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * @reference_uv: reference voltage (usually Nominal voltage)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * @optimized_uv: Optimized voltage from efuse
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct ti_opp_supply_optimum_voltage_table {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) unsigned int reference_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) unsigned int optimized_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * struct ti_opp_supply_data - OMAP specific opp supply data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * @vdd_table: Optimized voltage mapping table
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) * @num_vdd_table: number of entries in vdd_table
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) * @vdd_absolute_max_voltage_uv: absolute maximum voltage in UV for the supply
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) struct ti_opp_supply_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct ti_opp_supply_optimum_voltage_table *vdd_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) u32 num_vdd_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) u32 vdd_absolute_max_voltage_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) static struct ti_opp_supply_data opp_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) * struct ti_opp_supply_of_data - device tree match data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) * @flags: specific type of opp supply
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) * @efuse_voltage_mask: mask required for efuse register representing voltage
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) * @efuse_voltage_uv: Are the efuse entries in micro-volts? if not, assume
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) * milli-volts.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct ti_opp_supply_of_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) #define OPPDM_EFUSE_CLASS0_OPTIMIZED_VOLTAGE BIT(1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define OPPDM_HAS_NO_ABB BIT(2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) const u8 flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) const u32 efuse_voltage_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) const bool efuse_voltage_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * _store_optimized_voltages() - store optimized voltages
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) * @dev: ti opp supply device for which we need to store info
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) * @data: data specific to the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) * Picks up efuse based optimized voltages for VDD unique per device and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) * stores it in internal data structure for use during transition requests.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) * Return: If successful, 0, else appropriate error value.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static int _store_optimized_voltages(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct ti_opp_supply_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) void __iomem *base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) struct property *prop;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) const __be32 *val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) int proplen, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) struct ti_opp_supply_optimum_voltage_table *table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) const struct ti_opp_supply_of_data *of_data = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) /* pick up Efuse based voltages */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) res = platform_get_resource(to_platform_device(dev), IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (!res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) dev_err(dev, "Unable to get IO resource\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) ret = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) goto out_map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) base = ioremap(res->start, resource_size(res));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) if (!base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) dev_err(dev, "Unable to map Efuse registers\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) goto out_map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) /* Fetch efuse-settings. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) prop = of_find_property(dev->of_node, "ti,efuse-settings", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (!prop) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) dev_err(dev, "No 'ti,efuse-settings' property found\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) proplen = prop->length / sizeof(int);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) data->num_vdd_table = proplen / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) /* Verify for corrupted OPP entries in dt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) if (data->num_vdd_table * 2 * sizeof(int) != prop->length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) dev_err(dev, "Invalid 'ti,efuse-settings'\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) ret = of_property_read_u32(dev->of_node, "ti,absolute-max-voltage-uv",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) &data->vdd_absolute_max_voltage_uv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) dev_err(dev, "ti,absolute-max-voltage-uv is missing\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) table = kcalloc(data->num_vdd_table, sizeof(*data->vdd_table),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) if (!table) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) data->vdd_table = table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) val = prop->value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) for (i = 0; i < data->num_vdd_table; i++, table++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) u32 efuse_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) u32 tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) table->reference_uv = be32_to_cpup(val++);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) efuse_offset = be32_to_cpup(val++);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) tmp = readl(base + efuse_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) tmp &= of_data->efuse_voltage_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) tmp >>= __ffs(of_data->efuse_voltage_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) table->optimized_uv = of_data->efuse_voltage_uv ? tmp :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) tmp * 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) dev_dbg(dev, "[%d] efuse=0x%08x volt_table=%d vset=%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) i, efuse_offset, table->reference_uv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) table->optimized_uv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) * Some older samples might not have optimized efuse
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) * Use reference voltage for those - just add debug message
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) * for them.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) if (!table->optimized_uv) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) dev_dbg(dev, "[%d] efuse=0x%08x volt_table=%d:vset0\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) i, efuse_offset, table->reference_uv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) table->optimized_uv = table->reference_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) iounmap(base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) out_map:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) * _free_optimized_voltages() - free resources for optvoltages
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) * @dev: device for which we need to free info
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) * @data: data specific to the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static void _free_optimized_voltages(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) struct ti_opp_supply_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) kfree(data->vdd_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) data->vdd_table = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) data->num_vdd_table = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) * _get_optimal_vdd_voltage() - Finds optimal voltage for the supply
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) * @dev: device for which we need to find info
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) * @data: data specific to the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) * @reference_uv: reference voltage (OPP voltage) for which we need value
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) * Return: if a match is found, return optimized voltage, else return
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) * reference_uv, also return reference_uv if no optimization is needed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static int _get_optimal_vdd_voltage(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) struct ti_opp_supply_data *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) int reference_uv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) struct ti_opp_supply_optimum_voltage_table *table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) if (!data->num_vdd_table)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return reference_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) table = data->vdd_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) if (!table)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* Find a exact match - this list is usually very small */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) for (i = 0; i < data->num_vdd_table; i++, table++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) if (table->reference_uv == reference_uv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) return table->optimized_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) /* IF things are screwed up, we'd make a mess on console.. ratelimit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) dev_err_ratelimited(dev, "%s: Failed optimized voltage match for %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) __func__, reference_uv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) return reference_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) static int _opp_set_voltage(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) struct dev_pm_opp_supply *supply,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) int new_target_uv, struct regulator *reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) char *reg_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) unsigned long vdd_uv, uv_max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) if (new_target_uv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) vdd_uv = new_target_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) vdd_uv = supply->u_volt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) * If we do have an absolute max voltage specified, then we should
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) * use that voltage instead to allow for cases where the voltage rails
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) * are ganged (example if we set the max for an opp as 1.12v, and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) * the absolute max is 1.5v, for another rail to get 1.25v, it cannot
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) * be achieved if the regulator is constrainted to max of 1.12v, even
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) * if it can function at 1.25v
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) if (opp_data.vdd_absolute_max_voltage_uv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) uv_max = opp_data.vdd_absolute_max_voltage_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) uv_max = supply->u_volt_max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) if (vdd_uv > uv_max ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) vdd_uv < supply->u_volt_min ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) supply->u_volt_min > uv_max) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) dev_warn(dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) "Invalid range voltages [Min:%lu target:%lu Max:%lu]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) supply->u_volt_min, vdd_uv, uv_max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) dev_dbg(dev, "%s scaling to %luuV[min %luuV max %luuV]\n", reg_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) vdd_uv, supply->u_volt_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) uv_max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) ret = regulator_set_voltage_triplet(reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) supply->u_volt_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) vdd_uv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) uv_max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) dev_err(dev, "%s failed for %luuV[min %luuV max %luuV]\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) reg_name, vdd_uv, supply->u_volt_min,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) uv_max);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) * ti_opp_supply_set_opp() - do the opp supply transition
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) * @data: information on regulators and new and old opps provided by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) * opp core to use in transition
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) * Return: If successful, 0, else appropriate error value.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) static int ti_opp_supply_set_opp(struct dev_pm_set_opp_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) struct dev_pm_opp_supply *old_supply_vdd = &data->old_opp.supplies[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) struct dev_pm_opp_supply *old_supply_vbb = &data->old_opp.supplies[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) struct dev_pm_opp_supply *new_supply_vdd = &data->new_opp.supplies[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) struct dev_pm_opp_supply *new_supply_vbb = &data->new_opp.supplies[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) struct device *dev = data->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) unsigned long old_freq = data->old_opp.rate, freq = data->new_opp.rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) struct clk *clk = data->clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) struct regulator *vdd_reg = data->regulators[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) struct regulator *vbb_reg = data->regulators[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) int vdd_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) vdd_uv = _get_optimal_vdd_voltage(dev, &opp_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) new_supply_vdd->u_volt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) if (new_supply_vdd->u_volt_min < vdd_uv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) new_supply_vdd->u_volt_min = vdd_uv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) /* Scaling up? Scale voltage before frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) if (freq > old_freq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) ret = _opp_set_voltage(dev, new_supply_vdd, vdd_uv, vdd_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) "vdd");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) goto restore_voltage;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) ret = _opp_set_voltage(dev, new_supply_vbb, 0, vbb_reg, "vbb");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) goto restore_voltage;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) /* Change frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) dev_dbg(dev, "%s: switching OPP: %lu Hz --> %lu Hz\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) __func__, old_freq, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) ret = clk_set_rate(clk, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) dev_err(dev, "%s: failed to set clock rate: %d\n", __func__,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) goto restore_voltage;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) /* Scaling down? Scale voltage after frequency */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) if (freq < old_freq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) ret = _opp_set_voltage(dev, new_supply_vbb, 0, vbb_reg, "vbb");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) goto restore_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) ret = _opp_set_voltage(dev, new_supply_vdd, vdd_uv, vdd_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) "vdd");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) goto restore_freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) restore_freq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) ret = clk_set_rate(clk, old_freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) dev_err(dev, "%s: failed to restore old-freq (%lu Hz)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) __func__, old_freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) restore_voltage:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /* This shouldn't harm even if the voltages weren't updated earlier */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (old_supply_vdd->u_volt) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) ret = _opp_set_voltage(dev, old_supply_vbb, 0, vbb_reg, "vbb");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) ret = _opp_set_voltage(dev, old_supply_vdd, 0, vdd_reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) "vdd");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) static const struct ti_opp_supply_of_data omap_generic_of_data = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) static const struct ti_opp_supply_of_data omap_omap5_of_data = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) .flags = OPPDM_EFUSE_CLASS0_OPTIMIZED_VOLTAGE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) .efuse_voltage_mask = 0xFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) .efuse_voltage_uv = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) static const struct ti_opp_supply_of_data omap_omap5core_of_data = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) .flags = OPPDM_EFUSE_CLASS0_OPTIMIZED_VOLTAGE | OPPDM_HAS_NO_ABB,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) .efuse_voltage_mask = 0xFFF,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) .efuse_voltage_uv = false,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) static const struct of_device_id ti_opp_supply_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) {.compatible = "ti,omap-opp-supply", .data = &omap_generic_of_data},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) {.compatible = "ti,omap5-opp-supply", .data = &omap_omap5_of_data},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) {.compatible = "ti,omap5-core-opp-supply",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) .data = &omap_omap5core_of_data},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) {},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) MODULE_DEVICE_TABLE(of, ti_opp_supply_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) static int ti_opp_supply_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) struct device *cpu_dev = get_cpu_device(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) const struct of_device_id *match;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) const struct ti_opp_supply_of_data *of_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) match = of_match_device(ti_opp_supply_of_match, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (!match) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) /* We do not expect this to happen */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) dev_err(dev, "%s: Unable to match device\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (!match->data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) /* Again, unlikely.. but mistakes do happen */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) dev_err(dev, "%s: Bad data in match\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) of_data = match->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) dev_set_drvdata(dev, (void *)of_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) /* If we need optimized voltage */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (of_data->flags & OPPDM_EFUSE_CLASS0_OPTIMIZED_VOLTAGE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) ret = _store_optimized_voltages(dev, &opp_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) ret = PTR_ERR_OR_ZERO(dev_pm_opp_register_set_opp_helper(cpu_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) ti_opp_supply_set_opp));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) _free_optimized_voltages(dev, &opp_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) static struct platform_driver ti_opp_supply_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) .probe = ti_opp_supply_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) .name = "ti_opp_supply",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) .of_match_table = of_match_ptr(ti_opp_supply_of_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) module_platform_driver(ti_opp_supply_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) MODULE_DESCRIPTION("Texas Instruments OMAP OPP Supply driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) MODULE_AUTHOR("Texas Instruments Inc.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) MODULE_LICENSE("GPL v2");