| Message ID | 20190623164206.7467-12-tiny.windzz@gmail.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
| Series | add thermal driver for h6 | expand |
Hello Yangtao, On Sun, Jun 23, 2019 at 12:42:06PM -0400, Yangtao Li wrote: > This patch adds the support for allwinner h3 thermal sensor. > > Signed-off-by: Yangtao Li <tiny.windzz@gmail.com> > --- > drivers/thermal/sun8i_thermal.c | 72 +++++++++++++++++++++++++++++++++ > 1 file changed, 72 insertions(+) > > diff --git a/drivers/thermal/sun8i_thermal.c b/drivers/thermal/sun8i_thermal.c > index 260b24340f5b..c8ee291f3b17 100644 > --- a/drivers/thermal/sun8i_thermal.c > +++ b/drivers/thermal/sun8i_thermal.c > @@ -27,6 +27,14 @@ > #define TEMP_TO_REG 672 > #define CALIBRATE_DEFAULT 0x800 > > +#define SUN8I_THS_CTRL0 0x00 > +#define SUN8I_THS_CTRL2 0x40 > +#define SUN8I_THS_IC 0x44 > +#define SUN8I_THS_IS 0x48 > +#define SUN8I_THS_MFC 0x70 > +#define SUN8I_THS_TEMP_CALIB 0x74 > +#define SUN8I_THS_TEMP_DATA 0x80 > + > #define SUN50I_THS_CTRL0 0x00 > #define SUN50I_H6_THS_ENABLE 0x04 > #define SUN50I_H6_THS_PC 0x08 > @@ -36,6 +44,9 @@ > #define SUN50I_H6_THS_TEMP_CALIB 0xa0 > #define SUN50I_H6_THS_TEMP_DATA 0xc0 > > +#define SUN8I_THS_CTRL0_T_ACQ0(x) (GENMASK(15, 0) & (x)) > +#define SUN8I_THS_CTRL2_T_ACQ1(x) ((GENMASK(15, 0) & (x)) << 16) > + > #define SUN50I_THS_CTRL0_T_ACQ(x) ((GENMASK(15, 0) & (x)) << 16) > #define SUN50I_THS_FILTER_EN BIT(2) > #define SUN50I_THS_FILTER_TYPE(x) (GENMASK(1, 0) & (x)) > @@ -121,6 +132,21 @@ static const struct regmap_config config = { > .fast_io = true, > }; > > +static int sun8i_h3_irq_ack(struct ths_device *tmdev) > +{ > + int state, ret = 0; > + > + regmap_read(tmdev->regmap, SUN8I_THS_IS, &state); > + > + if (state & BIT(8)) { > + regmap_write(tmdev->regmap, SUN8I_THS_IS, > + BIT(8)); > + ret |= BIT(1); > + } > + > + return ret; > +} > + > static int sun50i_h6_irq_ack(struct ths_device *tmdev) > { > int i, state, ret = 0; > @@ -154,6 +180,14 @@ static irqreturn_t sun8i_irq_thread(int irq, void *data) > return IRQ_HANDLED; > } > > +static int sun8i_h3_ths_calibrate(struct ths_device *tmdev, > + u16 *caldata, int callen) > +{ > + regmap_write(tmdev->regmap, SUN8I_THS_TEMP_CALIB, *caldata); You're missing a sanity check for callen here. regards, o. > + return 0; > +} > + > static int sun50i_h6_ths_calibrate(struct ths_device *tmdev, > u16 *caldata, int callen) > { > @@ -325,6 +359,32 @@ static int sun8i_ths_resource_init(struct ths_device *tmdev) > return ret; > } > > +static int sun8i_h3_thermal_init(struct ths_device *tmdev) > +{ > + /* average over 4 samples */ > + regmap_write(tmdev->regmap, SUN8I_THS_MFC, > + SUN50I_THS_FILTER_EN | > + SUN50I_THS_FILTER_TYPE(1)); > + /* > + * period = (x + 1) * 4096 / clkin; ~10ms > + * enable data interrupt > + */ > + regmap_write(tmdev->regmap, SUN8I_THS_IC, > + SUN50I_H6_THS_PC_TEMP_PERIOD(58) | BIT(8)); > + /* > + * clkin = 24MHz > + * T acquire = clkin / (x + 1) > + * = 20us > + * enable sensor > + */ > + regmap_write(tmdev->regmap, SUN8I_THS_CTRL0, > + SUN8I_THS_CTRL0_T_ACQ0(479)); > + regmap_write(tmdev->regmap, SUN8I_THS_CTRL2, > + SUN8I_THS_CTRL2_T_ACQ1(479) | BIT(0)); > + > + return 0; > +} > + > static int sun50i_thermal_init(struct ths_device *tmdev) > { > int val; > @@ -431,6 +491,17 @@ static int sun8i_ths_remove(struct platform_device *pdev) > return 0; > } > > +static const struct ths_thermal_chip sun8i_h3_ths = { > + .sensor_num = 1, > + .offset = -1794, > + .scale = -121, > + .has_ahb_clk = true, > + .temp_data_base = SUN8I_THS_TEMP_DATA, > + .calibrate = sun8i_h3_ths_calibrate, > + .init = sun8i_h3_thermal_init, > + .irq_ack = sun8i_h3_irq_ack, > +}; > + > static const struct ths_thermal_chip sun50i_h6_ths = { > .sensor_num = 2, > .offset = -2794, > @@ -443,6 +514,7 @@ static const struct ths_thermal_chip sun50i_h6_ths = { > }; > > static const struct of_device_id of_ths_match[] = { > + { .compatible = "allwinner,sun8i-h3-ths", .data = &sun8i_h3_ths }, > { .compatible = "allwinner,sun50i-h6-ths", .data = &sun50i_h6_ths }, > { /* sentinel */ }, > }; > -- > 2.17.1 > > > _______________________________________________ > linux-arm-kernel mailing list > linux-arm-kernel@lists.infradead.org > http://lists.infradead.org/mailman/listinfo/linux-arm-kernel
diff --git a/drivers/thermal/sun8i_thermal.c b/drivers/thermal/sun8i_thermal.c index 260b24340f5b..c8ee291f3b17 100644 --- a/drivers/thermal/sun8i_thermal.c +++ b/drivers/thermal/sun8i_thermal.c @@ -27,6 +27,14 @@ #define TEMP_TO_REG 672 #define CALIBRATE_DEFAULT 0x800 +#define SUN8I_THS_CTRL0 0x00 +#define SUN8I_THS_CTRL2 0x40 +#define SUN8I_THS_IC 0x44 +#define SUN8I_THS_IS 0x48 +#define SUN8I_THS_MFC 0x70 +#define SUN8I_THS_TEMP_CALIB 0x74 +#define SUN8I_THS_TEMP_DATA 0x80 + #define SUN50I_THS_CTRL0 0x00 #define SUN50I_H6_THS_ENABLE 0x04 #define SUN50I_H6_THS_PC 0x08 @@ -36,6 +44,9 @@ #define SUN50I_H6_THS_TEMP_CALIB 0xa0 #define SUN50I_H6_THS_TEMP_DATA 0xc0 +#define SUN8I_THS_CTRL0_T_ACQ0(x) (GENMASK(15, 0) & (x)) +#define SUN8I_THS_CTRL2_T_ACQ1(x) ((GENMASK(15, 0) & (x)) << 16) + #define SUN50I_THS_CTRL0_T_ACQ(x) ((GENMASK(15, 0) & (x)) << 16) #define SUN50I_THS_FILTER_EN BIT(2) #define SUN50I_THS_FILTER_TYPE(x) (GENMASK(1, 0) & (x)) @@ -121,6 +132,21 @@ static const struct regmap_config config = { .fast_io = true, }; +static int sun8i_h3_irq_ack(struct ths_device *tmdev) +{ + int state, ret = 0; + + regmap_read(tmdev->regmap, SUN8I_THS_IS, &state); + + if (state & BIT(8)) { + regmap_write(tmdev->regmap, SUN8I_THS_IS, + BIT(8)); + ret |= BIT(1); + } + + return ret; +} + static int sun50i_h6_irq_ack(struct ths_device *tmdev) { int i, state, ret = 0; @@ -154,6 +180,14 @@ static irqreturn_t sun8i_irq_thread(int irq, void *data) return IRQ_HANDLED; } +static int sun8i_h3_ths_calibrate(struct ths_device *tmdev, + u16 *caldata, int callen) +{ + regmap_write(tmdev->regmap, SUN8I_THS_TEMP_CALIB, *caldata); + + return 0; +} + static int sun50i_h6_ths_calibrate(struct ths_device *tmdev, u16 *caldata, int callen) { @@ -325,6 +359,32 @@ static int sun8i_ths_resource_init(struct ths_device *tmdev) return ret; } +static int sun8i_h3_thermal_init(struct ths_device *tmdev) +{ + /* average over 4 samples */ + regmap_write(tmdev->regmap, SUN8I_THS_MFC, + SUN50I_THS_FILTER_EN | + SUN50I_THS_FILTER_TYPE(1)); + /* + * period = (x + 1) * 4096 / clkin; ~10ms + * enable data interrupt + */ + regmap_write(tmdev->regmap, SUN8I_THS_IC, + SUN50I_H6_THS_PC_TEMP_PERIOD(58) | BIT(8)); + /* + * clkin = 24MHz + * T acquire = clkin / (x + 1) + * = 20us + * enable sensor + */ + regmap_write(tmdev->regmap, SUN8I_THS_CTRL0, + SUN8I_THS_CTRL0_T_ACQ0(479)); + regmap_write(tmdev->regmap, SUN8I_THS_CTRL2, + SUN8I_THS_CTRL2_T_ACQ1(479) | BIT(0)); + + return 0; +} + static int sun50i_thermal_init(struct ths_device *tmdev) { int val; @@ -431,6 +491,17 @@ static int sun8i_ths_remove(struct platform_device *pdev) return 0; } +static const struct ths_thermal_chip sun8i_h3_ths = { + .sensor_num = 1, + .offset = -1794, + .scale = -121, + .has_ahb_clk = true, + .temp_data_base = SUN8I_THS_TEMP_DATA, + .calibrate = sun8i_h3_ths_calibrate, + .init = sun8i_h3_thermal_init, + .irq_ack = sun8i_h3_irq_ack, +}; + static const struct ths_thermal_chip sun50i_h6_ths = { .sensor_num = 2, .offset = -2794, @@ -443,6 +514,7 @@ static const struct ths_thermal_chip sun50i_h6_ths = { }; static const struct of_device_id of_ths_match[] = { + { .compatible = "allwinner,sun8i-h3-ths", .data = &sun8i_h3_ths }, { .compatible = "allwinner,sun50i-h6-ths", .data = &sun50i_h6_ths }, { /* sentinel */ }, };
This patch adds the support for allwinner h3 thermal sensor. Signed-off-by: Yangtao Li <tiny.windzz@gmail.com> --- drivers/thermal/sun8i_thermal.c | 72 +++++++++++++++++++++++++++++++++ 1 file changed, 72 insertions(+)