mirror of
https://github.com/Fishwaldo/build.git
synced 2025-03-27 01:02:19 +00:00
593 lines
18 KiB
Diff
593 lines
18 KiB
Diff
diff --git a/drivers/clk/sunxi-ng/ccu-sunxi-h3-h5.c b/drivers/clk/sunxi-ng/ccu-sunxi-h3-h5.c
|
|
index b7b9f85f..d117f2b5 100644
|
|
--- a/drivers/clk/sunxi-ng/ccu-sunxi-h3-h5.c
|
|
+++ b/drivers/clk/sunxi-ng/ccu-sunxi-h3-h5.c
|
|
@@ -29,15 +29,21 @@
|
|
|
|
#include "ccu-sunxi-h3-h5.h"
|
|
|
|
-static SUNXI_CCU_NKMP_WITH_GATE_LOCK(pll_cpux_clk, "pll-cpux",
|
|
- "osc24M", 0x000,
|
|
- 8, 5, /* N */
|
|
- 4, 2, /* K */
|
|
- 0, 2, /* M */
|
|
- 16, 2, /* P */
|
|
- BIT(31), /* gate */
|
|
- BIT(28), /* lock */
|
|
- 0);
|
|
+static struct ccu_nkmp pll_cpux_clk = {
|
|
+ .enable = BIT(31),
|
|
+ .lock = BIT(28),
|
|
+ .n = _SUNXI_CCU_MULT(8, 5),
|
|
+ .k = _SUNXI_CCU_MULT(4, 2),
|
|
+ .m = _SUNXI_CCU_DIV_MAX(0, 2, 1),
|
|
+ .p = _SUNXI_CCU_DIV(16, 2),
|
|
+ .common = {
|
|
+ .reg = 0x000,
|
|
+ .hw.init = CLK_HW_INIT("pll-cpux",
|
|
+ "osc24M",
|
|
+ &ccu_nkmp_ops,
|
|
+ 0),
|
|
+ },
|
|
+};
|
|
|
|
/*
|
|
* The Audio PLL is supposed to have 4 outputs: 3 fixed factors from
|
|
@@ -135,7 +141,7 @@ static SUNXI_CCU_NM_WITH_FRAC_GATE_LOCK(pll_de_clk, "pll-de",
|
|
static const char * const cpux_parents[] = { "osc32k", "osc24M",
|
|
"pll-cpux" , "pll-cpux" };
|
|
static SUNXI_CCU_MUX(cpux_clk, "cpux", cpux_parents,
|
|
- 0x050, 16, 2, CLK_IS_CRITICAL);
|
|
+ 0x050, 16, 2, CLK_IS_CRITICAL | CLK_SET_RATE_PARENT);
|
|
|
|
static SUNXI_CCU_M(axi_clk, "axi", "cpux", 0x050, 0, 2, 0);
|
|
|
|
diff --git a/drivers/clk/sunxi-ng/ccu_common.c b/drivers/clk/sunxi-ng/ccu_common.c
|
|
index 51d4bac9..9dc970ff 100644
|
|
--- a/drivers/clk/sunxi-ng/ccu_common.c
|
|
+++ b/drivers/clk/sunxi-ng/ccu_common.c
|
|
@@ -36,7 +36,7 @@ void ccu_helper_wait_for_lock(struct ccu_common *common, u32 lock)
|
|
else
|
|
addr = common->base + common->reg;
|
|
|
|
- WARN_ON(readl_relaxed_poll_timeout(addr, reg, reg & lock, 100, 70000));
|
|
+ WARN_ON(readl_relaxed_poll_timeout_atomic(addr, reg, reg & lock, 5, 70000));
|
|
}
|
|
|
|
int sunxi_ccu_probe(struct device_node *node, void __iomem *reg,
|
|
diff --git a/drivers/clk/sunxi-ng/ccu_nkmp.c b/drivers/clk/sunxi-ng/ccu_nkmp.c
|
|
index a2b40a00..6e472872 100644
|
|
--- a/drivers/clk/sunxi-ng/ccu_nkmp.c
|
|
+++ b/drivers/clk/sunxi-ng/ccu_nkmp.c
|
|
@@ -30,7 +30,7 @@ static void ccu_nkmp_find_best(unsigned long parent, unsigned long rate,
|
|
for (_k = nkmp->min_k; _k <= nkmp->max_k; _k++) {
|
|
for (_n = nkmp->min_n; _n <= nkmp->max_n; _n++) {
|
|
for (_m = nkmp->min_m; _m <= nkmp->max_m; _m++) {
|
|
- for (_p = nkmp->min_p; _p <= nkmp->max_p; _p <<= 1) {
|
|
+ for (_p = nkmp->min_p; _p <= (rate <= 288000000 ? nkmp->max_p : nkmp->min_p); _p <<= 1) {
|
|
unsigned long tmp_rate;
|
|
|
|
tmp_rate = parent * _n * _k / (_m * _p);
|
|
diff --git a/drivers/cpufreq/cpufreq-dt-platdev.c b/drivers/cpufreq/cpufreq-dt-platdev.c
|
|
index 7fcaf26e..e79543b0 100644
|
|
--- a/drivers/cpufreq/cpufreq-dt-platdev.c
|
|
+++ b/drivers/cpufreq/cpufreq-dt-platdev.c
|
|
@@ -25,6 +25,7 @@ static const struct of_device_id machines[] __initconst = {
|
|
{ .compatible = "allwinner,sun8i-a33", },
|
|
{ .compatible = "allwinner,sun8i-a83t", },
|
|
{ .compatible = "allwinner,sun8i-h3", },
|
|
+ { .compatible = "allwinner,sun50i-h5", },
|
|
|
|
{ .compatible = "apm,xgene-shadowcat", },
|
|
|
|
diff --git a/drivers/regulator/Kconfig b/drivers/regulator/Kconfig
|
|
index 936f7ccc..f26cf927 100644
|
|
--- a/drivers/regulator/Kconfig
|
|
+++ b/drivers/regulator/Kconfig
|
|
@@ -720,6 +720,13 @@ config REGULATOR_STW481X_VMMC
|
|
This driver supports the internal VMMC regulator in the STw481x
|
|
PMIC chips.
|
|
|
|
+config REGULATOR_SY8106A
|
|
+ tristate "Silergy SY8106A"
|
|
+ depends on I2C && (OF || COMPILE_TEST)
|
|
+ select REGMAP_I2C
|
|
+ help
|
|
+ This driver provides support for SY8106A voltage regulator.
|
|
+
|
|
config REGULATOR_TPS51632
|
|
tristate "TI TPS51632 Power Regulator"
|
|
depends on I2C
|
|
@@ -879,4 +886,3 @@ config REGULATOR_WM8994
|
|
WM8994 CODEC.
|
|
|
|
endif
|
|
-
|
|
diff --git a/drivers/regulator/Makefile b/drivers/regulator/Makefile
|
|
index 14294692..135b191c 100644
|
|
--- a/drivers/regulator/Makefile
|
|
+++ b/drivers/regulator/Makefile
|
|
@@ -90,6 +90,7 @@ obj-$(CONFIG_REGULATOR_S2MPS11) += s2mps11.o
|
|
obj-$(CONFIG_REGULATOR_S5M8767) += s5m8767.o
|
|
obj-$(CONFIG_REGULATOR_SKY81452) += sky81452-regulator.o
|
|
obj-$(CONFIG_REGULATOR_STW481X_VMMC) += stw481x-vmmc.o
|
|
+obj-$(CONFIG_REGULATOR_SY8106A) += sy8106a-regulator.o
|
|
obj-$(CONFIG_REGULATOR_TI_ABB) += ti-abb-regulator.o
|
|
obj-$(CONFIG_REGULATOR_TPS6105X) += tps6105x-regulator.o
|
|
obj-$(CONFIG_REGULATOR_TPS62360) += tps62360-regulator.o
|
|
@@ -113,5 +114,4 @@ obj-$(CONFIG_REGULATOR_WM8350) += wm8350-regulator.o
|
|
obj-$(CONFIG_REGULATOR_WM8400) += wm8400-regulator.o
|
|
obj-$(CONFIG_REGULATOR_WM8994) += wm8994-regulator.o
|
|
|
|
-
|
|
ccflags-$(CONFIG_REGULATOR_DEBUG) += -DDEBUG
|
|
diff --git a/drivers/regulator/sy8106a-regulator.c b/drivers/regulator/sy8106a-regulator.c
|
|
new file mode 100644
|
|
index 00000000..daa3d5d9
|
|
--- /dev/null
|
|
+++ b/drivers/regulator/sy8106a-regulator.c
|
|
@@ -0,0 +1,187 @@
|
|
+/*
|
|
+ * sy8106a-regulator.c - Regulator device driver for SY8106A
|
|
+ *
|
|
+ * Copyright (C) 2016 Ondřej Jirman <megous@megous.com>
|
|
+ *
|
|
+ * This library is free software; you can redistribute it and/or
|
|
+ * modify it under the terms of the GNU Library General Public
|
|
+ * License as published by the Free Software Foundation; either
|
|
+ * version 2 of the License, or (at your option) any later version.
|
|
+ *
|
|
+ * This library is distributed in the hope that it will be useful,
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
+ * Library General Public License for more details.
|
|
+ *
|
|
+ * You should have received a copy of the GNU Library General Public
|
|
+ * License along with this library; if not, write to the
|
|
+ * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
|
|
+ * Boston, MA 02110-1301, USA.
|
|
+ */
|
|
+
|
|
+#include <linux/err.h>
|
|
+#include <linux/i2c.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/regmap.h>
|
|
+#include <linux/regulator/driver.h>
|
|
+#include <linux/regulator/of_regulator.h>
|
|
+
|
|
+#define SY8106A_REG_VOUT1_SEL 0x01
|
|
+#define SY8106A_REG_VOUT_COM 0x02
|
|
+#define SY8106A_REG_VOUT1_SEL_MASK 0x7f
|
|
+#define SY8106A_DISABLE_REG BIT(0)
|
|
+#define SY8106A_GO_BIT BIT(7)
|
|
+
|
|
+struct sy8106a {
|
|
+ struct regulator_dev *rdev;
|
|
+ struct regmap *regmap;
|
|
+};
|
|
+
|
|
+static const struct regmap_config sy8106a_regmap_config = {
|
|
+ .reg_bits = 8,
|
|
+ .val_bits = 8,
|
|
+};
|
|
+
|
|
+static int sy8106a_set_voltage_sel(struct regulator_dev *rdev, unsigned sel)
|
|
+{
|
|
+ /* We use our set_voltage_sel in order to avoid unnecessary I2C chatter,
|
|
+ * because the regulator_get_voltage_sel_regmap using apply_bit
|
|
+ * would perform 4 unnecessary transfers instead of one, increasing the
|
|
+ * chance of error.
|
|
+ */
|
|
+ return regmap_write(rdev->regmap, rdev->desc->vsel_reg,
|
|
+ sel | SY8106A_GO_BIT);
|
|
+}
|
|
+
|
|
+static int sy8106a_get_voltage_sel(struct regulator_dev *rdev)
|
|
+{
|
|
+ /* By default the sy8106a controller sets the voltage to 1100v.
|
|
+ */
|
|
+ unsigned int val;
|
|
+ int ret;
|
|
+
|
|
+ ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val);
|
|
+ if (ret != 0)
|
|
+ return ret;
|
|
+
|
|
+ if (!(val & SY8106A_GO_BIT))
|
|
+ return 42;
|
|
+
|
|
+ val &= rdev->desc->vsel_mask;
|
|
+ val >>= ffs(rdev->desc->vsel_mask) - 1;
|
|
+
|
|
+ return val;
|
|
+}
|
|
+
|
|
+static const struct regulator_ops sy8106a_ops = {
|
|
+ .is_enabled = regulator_is_enabled_regmap,
|
|
+ .set_voltage_sel = sy8106a_set_voltage_sel,
|
|
+ .set_voltage_time_sel = regulator_set_voltage_time_sel,
|
|
+ .get_voltage_sel = sy8106a_get_voltage_sel,
|
|
+ .list_voltage = regulator_list_voltage_linear,
|
|
+};
|
|
+
|
|
+/* Default limits measured in millivolts and milliamps */
|
|
+#define SY8106A_MIN_MV 680
|
|
+#define SY8106A_MAX_MV 1950
|
|
+#define SY8106A_STEP_MV 10
|
|
+
|
|
+static const struct regulator_desc sy8106a_reg = {
|
|
+ .name = "SY8106A",
|
|
+ .id = 0,
|
|
+ .ops = &sy8106a_ops,
|
|
+ .type = REGULATOR_VOLTAGE,
|
|
+ .n_voltages = ((SY8106A_MAX_MV - SY8106A_MIN_MV) / SY8106A_STEP_MV) + 1,
|
|
+ .min_uV = (SY8106A_MIN_MV * 1000),
|
|
+ .uV_step = (SY8106A_STEP_MV * 1000),
|
|
+ .vsel_reg = SY8106A_REG_VOUT1_SEL,
|
|
+ .vsel_mask = SY8106A_REG_VOUT1_SEL_MASK,
|
|
+ .enable_reg = SY8106A_REG_VOUT_COM,
|
|
+ .enable_mask = SY8106A_DISABLE_REG,
|
|
+ .disable_val = SY8106A_DISABLE_REG,
|
|
+ .enable_is_inverted = 1,
|
|
+ .owner = THIS_MODULE,
|
|
+};
|
|
+
|
|
+/*
|
|
+ * I2C driver interface functions
|
|
+ */
|
|
+static int sy8106a_i2c_probe(struct i2c_client *i2c,
|
|
+ const struct i2c_device_id *id)
|
|
+{
|
|
+ struct sy8106a *chip;
|
|
+ struct device *dev = &i2c->dev;
|
|
+ struct regulator_dev *rdev = NULL;
|
|
+ struct regulator_config config = { };
|
|
+ unsigned int selector;
|
|
+ int error;
|
|
+
|
|
+ chip = devm_kzalloc(&i2c->dev, sizeof(struct sy8106a), GFP_KERNEL);
|
|
+ if (!chip)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ chip->regmap = devm_regmap_init_i2c(i2c, &sy8106a_regmap_config);
|
|
+ if (IS_ERR(chip->regmap)) {
|
|
+ error = PTR_ERR(chip->regmap);
|
|
+ dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
|
|
+ error);
|
|
+ return error;
|
|
+ }
|
|
+
|
|
+ config.dev = &i2c->dev;
|
|
+ config.regmap = chip->regmap;
|
|
+ config.driver_data = chip;
|
|
+
|
|
+ config.of_node = dev->of_node;
|
|
+ config.init_data = of_get_regulator_init_data(dev, dev->of_node, &sy8106a_reg);
|
|
+ if (!config.init_data) {
|
|
+ return -ENOMEM;
|
|
+ }
|
|
+
|
|
+ /* Probe regulator */
|
|
+ error = regmap_read(chip->regmap, SY8106A_REG_VOUT1_SEL, &selector);
|
|
+ if (error) {
|
|
+ dev_err(&i2c->dev, "Failed to read voltage at probe time: %d\n", error);
|
|
+ return error;
|
|
+ }
|
|
+
|
|
+ rdev = devm_regulator_register(&i2c->dev, &sy8106a_reg, &config);
|
|
+ if (IS_ERR(rdev)) {
|
|
+ error = PTR_ERR(rdev);
|
|
+ dev_err(&i2c->dev, "Failed to register SY8106A regulator: %d\n", error);
|
|
+ return error;
|
|
+ }
|
|
+
|
|
+ chip->rdev = rdev;
|
|
+
|
|
+ i2c_set_clientdata(i2c, chip);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id sy8106a_i2c_of_match[] = {
|
|
+ { .compatible = "silergy,sy8106a" },
|
|
+ { },
|
|
+};
|
|
+MODULE_DEVICE_TABLE(of, sy8106a_i2c_of_match);
|
|
+
|
|
+static const struct i2c_device_id sy8106a_i2c_id[] = {
|
|
+ { "sy8106a", 0 },
|
|
+ { },
|
|
+};
|
|
+MODULE_DEVICE_TABLE(i2c, sy8106a_i2c_id);
|
|
+
|
|
+static struct i2c_driver sy8106a_regulator_driver = {
|
|
+ .driver = {
|
|
+ .name = "sy8106a",
|
|
+ .of_match_table = of_match_ptr(sy8106a_i2c_of_match),
|
|
+ },
|
|
+ .probe = sy8106a_i2c_probe,
|
|
+ .id_table = sy8106a_i2c_id,
|
|
+};
|
|
+
|
|
+module_i2c_driver(sy8106a_regulator_driver);
|
|
+
|
|
+MODULE_AUTHOR("Ondřej Jirman <megous@megous.com>");
|
|
+MODULE_DESCRIPTION("Regulator device driver for Silergy SY8106A");
|
|
+MODULE_LICENSE("GPL v2");
|
|
diff --git a/drivers/thermal/Kconfig b/drivers/thermal/Kconfig
|
|
index 3912d24a..ffc9b9ca 100644
|
|
--- a/drivers/thermal/Kconfig
|
|
+++ b/drivers/thermal/Kconfig
|
|
@@ -392,6 +392,13 @@ config MTK_THERMAL
|
|
Enable this option if you want to have support for thermal management
|
|
controller present in Mediatek SoCs
|
|
|
|
+config SUN8I_THS
|
|
+ tristate "Thermal sensor driver for Allwinner H3"
|
|
+ depends on MACH_SUN8I || (ARCH_SUNXI && ARM64)
|
|
+ depends on OF
|
|
+ help
|
|
+ Enable this to support thermal reporting on some newer Allwinner SoCs.
|
|
+
|
|
menu "Texas Instruments thermal drivers"
|
|
depends on ARCH_HAS_BANDGAP || COMPILE_TEST
|
|
depends on HAS_IOMEM
|
|
diff --git a/drivers/thermal/Makefile b/drivers/thermal/Makefile
|
|
index adcf3cc9..1d27dadb 100644
|
|
--- a/drivers/thermal/Makefile
|
|
+++ b/drivers/thermal/Makefile
|
|
@@ -57,3 +57,4 @@ obj-$(CONFIG_TEGRA_SOCTHERM) += tegra/
|
|
obj-$(CONFIG_HISI_THERMAL) += hisi_thermal.o
|
|
obj-$(CONFIG_MTK_THERMAL) += mtk_thermal.o
|
|
obj-$(CONFIG_GENERIC_ADC_THERMAL) += thermal-generic-adc.o
|
|
+obj-$(CONFIG_SUN8I_THS) += sun8i_ths.o
|
|
diff --git a/drivers/thermal/sun8i_ths.c b/drivers/thermal/sun8i_ths.c
|
|
new file mode 100644
|
|
index 00000000..74fb451d
|
|
--- /dev/null
|
|
+++ b/drivers/thermal/sun8i_ths.c
|
|
@@ -0,0 +1,244 @@
|
|
+/*
|
|
+ * Thermal sensor driver for Allwinner H3 SoC
|
|
+ *
|
|
+ * Copyright (C) 2016 Ondřej Jirman
|
|
+ * Based on the work of Josef Gajdusek <atx@atx.name>
|
|
+ *
|
|
+ * This software is licensed under the terms of the GNU General Public
|
|
+ * License version 2, as published by the Free Software Foundation, and
|
|
+ * may be copied, distributed, and modified under those terms.
|
|
+ *
|
|
+ * This program is distributed in the hope that it will be useful,
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
+ * GNU General Public License for more details.
|
|
+ *
|
|
+ */
|
|
+
|
|
+#include <linux/clk.h>
|
|
+#include <linux/interrupt.h>
|
|
+#include <linux/io.h>
|
|
+#include <linux/module.h>
|
|
+#include <linux/of_device.h>
|
|
+#include <linux/platform_device.h>
|
|
+#include <linux/reset.h>
|
|
+#include <linux/slab.h>
|
|
+#include <linux/thermal.h>
|
|
+#include <linux/printk.h>
|
|
+
|
|
+#define THS_H3_CTRL0 0x00
|
|
+#define THS_H3_CTRL2 0x40
|
|
+#define THS_H3_INT_CTRL 0x44
|
|
+#define THS_H3_STAT 0x48
|
|
+#define THS_H3_FILTER 0x70
|
|
+#define THS_H3_CDATA 0x74
|
|
+#define THS_H3_DATA 0x80
|
|
+
|
|
+#define THS_H3_CTRL0_SENSOR_ACQ0(x) (x)
|
|
+#define THS_H3_CTRL2_SENSE_EN BIT(0)
|
|
+#define THS_H3_CTRL2_SENSOR_ACQ1(x) ((x) << 16)
|
|
+#define THS_H3_INT_CTRL_DATA_IRQ_EN BIT(8)
|
|
+#define THS_H3_INT_CTRL_THERMAL_PER(x) ((x) << 12)
|
|
+#define THS_H3_STAT_DATA_IRQ_STS BIT(8)
|
|
+#define THS_H3_FILTER_TYPE(x) ((x) << 0)
|
|
+#define THS_H3_FILTER_EN BIT(2)
|
|
+
|
|
+#define THS_H3_CLK_IN 40000000 /* Hz */
|
|
+#define THS_H3_DATA_PERIOD 330 /* ms */
|
|
+
|
|
+#define THS_H3_FILTER_TYPE_VALUE 2 /* average over 2^(n+1) samples */
|
|
+#define THS_H3_FILTER_DIV (1 << (THS_H3_FILTER_TYPE_VALUE + 1))
|
|
+#define THS_H3_INT_CTRL_THERMAL_PER_VALUE \
|
|
+ (THS_H3_DATA_PERIOD * (THS_H3_CLK_IN / 1000) / THS_H3_FILTER_DIV / 4096 - 1)
|
|
+#define THS_H3_CTRL0_SENSOR_ACQ0_VALUE 0x3f /* 16us */
|
|
+#define THS_H3_CTRL2_SENSOR_ACQ1_VALUE 0x3f
|
|
+
|
|
+struct sun8i_ths_data {
|
|
+ struct reset_control *reset;
|
|
+ struct clk *clk;
|
|
+ struct clk *busclk;
|
|
+ void __iomem *regs;
|
|
+ struct thermal_zone_device *tzd;
|
|
+ u32 temp;
|
|
+};
|
|
+
|
|
+static int sun8i_ths_get_temp(void *_data, int *out)
|
|
+{
|
|
+ struct sun8i_ths_data *data = _data;
|
|
+
|
|
+ if (data->temp == 0)
|
|
+ return -EBUSY;
|
|
+
|
|
+ /* Formula and parameters from H5 User Manual */
|
|
+ if (data->temp < 0x500) {
|
|
+ *out = 223000 - (int)((data->temp * 1191 / 10));
|
|
+ } else {
|
|
+ *out = 259000 - (int)((data->temp * 1452 / 10));
|
|
+ }
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static irqreturn_t sun8i_ths_irq_thread(int irq, void *_data)
|
|
+{
|
|
+ struct sun8i_ths_data *data = _data;
|
|
+
|
|
+ writel(THS_H3_STAT_DATA_IRQ_STS, data->regs + THS_H3_STAT);
|
|
+
|
|
+ data->temp = readl(data->regs + THS_H3_DATA);
|
|
+ if (data->temp)
|
|
+ thermal_zone_device_update(data->tzd, THERMAL_EVENT_TEMP_SAMPLE);
|
|
+
|
|
+ return IRQ_HANDLED;
|
|
+}
|
|
+
|
|
+static void sun8i_ths_h3_init(struct sun8i_ths_data *data)
|
|
+{
|
|
+ writel(THS_H3_CTRL0_SENSOR_ACQ0(THS_H3_CTRL0_SENSOR_ACQ0_VALUE),
|
|
+ data->regs + THS_H3_CTRL0);
|
|
+ writel(THS_H3_FILTER_EN | THS_H3_FILTER_TYPE(THS_H3_FILTER_TYPE_VALUE),
|
|
+ data->regs + THS_H3_FILTER);
|
|
+ writel(THS_H3_CTRL2_SENSOR_ACQ1(THS_H3_CTRL2_SENSOR_ACQ1_VALUE) |
|
|
+ THS_H3_CTRL2_SENSE_EN,
|
|
+ data->regs + THS_H3_CTRL2);
|
|
+ writel(THS_H3_INT_CTRL_THERMAL_PER(THS_H3_INT_CTRL_THERMAL_PER_VALUE) |
|
|
+ THS_H3_INT_CTRL_DATA_IRQ_EN,
|
|
+ data->regs + THS_H3_INT_CTRL);
|
|
+}
|
|
+
|
|
+static const struct thermal_zone_of_device_ops sun8i_ths_thermal_ops = {
|
|
+ .get_temp = sun8i_ths_get_temp,
|
|
+};
|
|
+
|
|
+static int sun8i_ths_probe(struct platform_device *pdev)
|
|
+{
|
|
+ struct sun8i_ths_data *data;
|
|
+ struct resource *res;
|
|
+ int ret;
|
|
+ int irq;
|
|
+
|
|
+ data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
|
|
+ if (!data)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
+ if (!res) {
|
|
+ dev_err(&pdev->dev, "no memory resources defined\n");
|
|
+ return -EINVAL;
|
|
+ }
|
|
+
|
|
+ data->regs = devm_ioremap_resource(&pdev->dev, res);
|
|
+ if (IS_ERR(data->regs)) {
|
|
+ ret = PTR_ERR(data->regs);
|
|
+ dev_err(&pdev->dev, "failed to ioremap THS registers: %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ irq = platform_get_irq(pdev, 0);
|
|
+ if (irq < 0) {
|
|
+ dev_err(&pdev->dev, "failed to get IRQ: %d\n", irq);
|
|
+ return irq;
|
|
+ }
|
|
+
|
|
+ ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
|
|
+ sun8i_ths_irq_thread, IRQF_ONESHOT,
|
|
+ dev_name(&pdev->dev), data);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ data->busclk = devm_clk_get(&pdev->dev, "ahb");
|
|
+ if (IS_ERR(data->busclk)) {
|
|
+ ret = PTR_ERR(data->busclk);
|
|
+ dev_err(&pdev->dev, "failed to get ahb clk: %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ data->clk = devm_clk_get(&pdev->dev, "ths");
|
|
+ if (IS_ERR(data->clk)) {
|
|
+ ret = PTR_ERR(data->clk);
|
|
+ dev_err(&pdev->dev, "failed to get ths clk: %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ data->reset = devm_reset_control_get(&pdev->dev, "ahb");
|
|
+ if (IS_ERR(data->reset)) {
|
|
+ ret = PTR_ERR(data->reset);
|
|
+ dev_err(&pdev->dev, "failed to get reset: %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ ret = reset_control_deassert(data->reset);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev, "reset deassert failed: %d\n", ret);
|
|
+ return ret;
|
|
+ }
|
|
+
|
|
+ ret = clk_prepare_enable(data->busclk);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev, "failed to enable bus clk: %d\n", ret);
|
|
+ goto err_assert_reset;
|
|
+ }
|
|
+
|
|
+ ret = clk_prepare_enable(data->clk);
|
|
+ if (ret) {
|
|
+ dev_err(&pdev->dev, "failed to enable ths clk: %d\n", ret);
|
|
+ goto err_disable_bus;
|
|
+ }
|
|
+
|
|
+ ret = clk_set_rate(data->clk, THS_H3_CLK_IN);
|
|
+ if (ret)
|
|
+ goto err_disable_ths;
|
|
+
|
|
+ data->tzd = devm_thermal_zone_of_sensor_register(&pdev->dev, 0, data,
|
|
+ &sun8i_ths_thermal_ops);
|
|
+ if (IS_ERR(data->tzd)) {
|
|
+ ret = PTR_ERR(data->tzd);
|
|
+ dev_err(&pdev->dev, "failed to register thermal zone: %d\n",
|
|
+ ret);
|
|
+ goto err_disable_ths;
|
|
+ }
|
|
+
|
|
+ sun8i_ths_h3_init(data);
|
|
+
|
|
+ platform_set_drvdata(pdev, data);
|
|
+ return 0;
|
|
+
|
|
+err_disable_ths:
|
|
+ clk_disable_unprepare(data->clk);
|
|
+err_disable_bus:
|
|
+ clk_disable_unprepare(data->busclk);
|
|
+err_assert_reset:
|
|
+ reset_control_assert(data->reset);
|
|
+ return ret;
|
|
+}
|
|
+
|
|
+static int sun8i_ths_remove(struct platform_device *pdev)
|
|
+{
|
|
+ struct sun8i_ths_data *data = platform_get_drvdata(pdev);
|
|
+
|
|
+ reset_control_assert(data->reset);
|
|
+ clk_disable_unprepare(data->clk);
|
|
+ clk_disable_unprepare(data->busclk);
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static const struct of_device_id sun8i_ths_id_table[] = {
|
|
+ { .compatible = "allwinner,sun8i-h3-ths", },
|
|
+ { /* sentinel */ },
|
|
+};
|
|
+MODULE_DEVICE_TABLE(of, sun8i_ths_id_table);
|
|
+
|
|
+static struct platform_driver sun8i_ths_driver = {
|
|
+ .probe = sun8i_ths_probe,
|
|
+ .remove = sun8i_ths_remove,
|
|
+ .driver = {
|
|
+ .name = "sun8i_ths",
|
|
+ .of_match_table = sun8i_ths_id_table,
|
|
+ },
|
|
+};
|
|
+
|
|
+module_platform_driver(sun8i_ths_driver);
|
|
+
|
|
+MODULE_AUTHOR("Ondřej Jirman <megous@megous.com>");
|
|
+MODULE_DESCRIPTION("Thermal sensor driver for Allwinner H3 SoC");
|
|
+MODULE_LICENSE("GPL v2");
|