thermal: mediatek: add suspend/resume callback
Subsystems (2)
PATCH RESEND 1/1 thermal: mediatek: add suspend/resume callback
Louis Yu (1):
thermal: mediatek: add suspend/resume callback
drivers/thermal/mtk_thermal.c | 134 +++++++++++++++++++++++++++++++--- 1 file changed, 125 insertions(+), 9 deletions(-)
PATCH RESEND 1/1 thermal: mediatek: add suspend/resume callback
From: Louis Yu <[email protected]>
Add suspend/resume callback to disable/enable Mediatek thermal sensor respectively. Since thermal power domain is off in suspend, thermal driver needs re-initialization during resume.
--- drivers/thermal/mtk_thermal.c | 134 +++++++++++++++++++++++++++++++--- 1 file changed, 125 insertions(+), 9 deletions(-)
drivers/thermal/mtk_thermal.c +125 -9
@@ -22,6 +22,7 @@#include <linux/thermal.h> #include <linux/reset.h> #include <linux/types.h> +#include <linux/iopoll.h> /* AUXADC Registers */ #define AUXADC_CON1_SET_V 0x008
@@ -31,6 +32,8 @@#define APMIXED_SYS_TS_CON1 0x604 +#define APMIXED_SYS_TS_CON1_BUFFER_OFF 0x30 +/* Thermal Controller Registers */ #define TEMP_MONCTL0 0x000#define TEMP_MONCTL1 0x004
@@ -38,6 +41,7 @@#define TEMP_MONIDET0 0x014#define TEMP_MONIDET1 0x018#define TEMP_MSRCTL0 0x038 +#define TEMP_MSRCTL1 0x03c#define TEMP_AHBPOLL 0x040#define TEMP_AHBTO 0x044#define TEMP_ADCPNP0 0x048
@@ -87,6 +91,9 @@#define TEMP_ADCVALIDMASK_VALID_HIGH BIT(5)#define TEMP_ADCVALIDMASK_VALID_POS (bit) (bit) +#define TEMP_MSRCTL1_BUS_STA (BIT(0) | BIT(7)) +#define TEMP_MSRCTL1_SENSING_POINTS_PAUSE 0x10E +/* MT8173 thermal sensors */ #define MT8173_TS1 0#define MT8173_TS2 1
@@ -250,6 +257,10 @@ struct mtk_thermal_data {struct mtk_thermal {struct device *dev;void __iomem *thermal_base; +void __iomem *apmixed_base; +void __iomem *auxadc_base; +u64 apmixed_phys_base; +u64 auxadc_phys_base;struct clk *clk_peri_therm;struct clk *clk_auxadc;
@@ -746,6 +757,42 @@ static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num,mtk_thermal_put_bank (bank); } +static int mtk_thermal_disable_sensing (struct mtk_thermal *mt,int num) +{ +struct mtk_thermal_bank *bank = &mt->banks[num]; +u32 val; +unsigned long timeout; +void __iomem *addr; +int ret =0 ; + + bank->id = num; + bank->mt = mt; + +mtk_thermal_get_bank (bank); + + val =readl (mt->thermal_base +TEMP_MSRCTL1 ); +/* pause periodic temperature measurement for sensing points */ +writel (val |TEMP_MSRCTL1_SENSING_POINTS_PAUSE , + mt->thermal_base +TEMP_MSRCTL1 ); + +/* wait until temperature measurement bus idle */ + timeout = jiffies +HZ ; + addr = mt->thermal_base +TEMP_MSRCTL1 ; + + ret =readl_poll_timeout (addr, val, (val &TEMP_MSRCTL1_BUS_STA ) ==0x0 , +0 , timeout); +if (ret <0 ) + goto out; + +/* disable periodic temperature meausrement on sensing points */ +writel (0x0 , mt->thermal_base +TEMP_MONCTL0 ); + +out: +mtk_thermal_put_bank (bank); + +return ret; +} +static u64 of_get_phys_base (struct device_node *np) {u64 size64;
@@ -868,7 +915,6 @@ static int mtk_thermal_probe(struct platform_device *pdev)struct device_node *auxadc, *apmixedsys, *np = pdev->dev.of_node;struct mtk_thermal *mt;struct resource *res; -u64 auxadc_phys_base, apmixed_phys_base;struct thermal_zone_device *tzdev; mt =devm_kzalloc (&pdev->dev,sizeof (*mt),GFP_KERNEL );
@@ -904,11 +950,11 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - auxadc_phys_base =of_get_phys_base (auxadc); + mt->auxadc_phys_base =of_get_phys_base (auxadc);of_node_put (auxadc); -if (auxadc_phys_base ==OF_BAD_ADDR ) { +if (mt->auxadc_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }
@@ -919,11 +965,12 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_base =of_iomap (apmixedsys,0 );of_node_put (apmixedsys); -if (apmixed_phys_base ==OF_BAD_ADDR ) { +if (mt->apmixed_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }
@@ -935,19 +982,19 @@ static int mtk_thermal_probe(struct platform_device *pdev) ret =clk_prepare_enable (mt->clk_auxadc);if (ret) {dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); -return ret; + goto err_disable_clk_auxadc; } ret =clk_prepare_enable (mt->clk_peri_therm);if (ret) {dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); - goto err_disable_clk_auxadc; + goto err_disable_clk_peri_therm; }for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++)for (i =0 ; i < mt->conf->num_banks; i++) -mtk_thermal_init_bank (mt, i, apmixed_phys_base, - auxadc_phys_base, ctrl_id); +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id);platform_set_drvdata (pdev, mt);
@@ -978,11 +1025,80 @@ static int mtk_thermal_remove(struct platform_device *pdev)return 0 ; } +static int __maybe_unused mtk_thermal_suspend (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret; + +for (i =0 ; i < mt->conf->num_banks; i++) { + ret =mtk_thermal_disable_sensing (mt, i); +if (ret) + goto out; + } + +/* disable buffer */ +writel (readl (mt->apmixed_base +APMIXED_SYS_TS_CON1 ) | +APMIXED_SYS_TS_CON1_BUFFER_OFF , + mt->apmixed_base +APMIXED_SYS_TS_CON1 ); + +clk_disable_unprepare (mt->clk_peri_therm); +clk_disable_unprepare (mt->clk_auxadc); + +return 0 ; + +out: +dev_err (&pdev->dev,"Failed to wait until bus idle\n" ); + +return ret; +} + +static int __maybe_unused mtk_thermal_resume (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret, ctrl_id; + + ret =device_reset (&pdev->dev); +if (ret) +return ret; + + ret =clk_prepare_enable (mt->clk_auxadc); +if (ret) { +dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); + goto err_disable_clk_auxadc; + } + + ret =clk_prepare_enable (mt->clk_peri_therm); +if (ret) { +dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); + goto err_disable_clk_peri_therm; + } + +for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++) +for (i =0 ; i < mt->conf->num_banks; i++) +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id); + +return 0 ; + +err_disable_clk_peri_therm: +clk_disable_unprepare (mt->clk_peri_therm); +err_disable_clk_auxadc: +clk_disable_unprepare (mt->clk_auxadc); + +return ret; +} + +static SIMPLE_DEV_PM_OPS(mtk_thermal_pm_ops, + mtk_thermal_suspend, mtk_thermal_resume); +static struct platform_driver mtk_thermal_driver = { .probe = mtk_thermal_probe, .remove = mtk_thermal_remove, .driver = { .name ="mtk-thermal" , + .pm = &mtk_thermal_pm_ops, .of_match_table = mtk_thermal_of_match, }, };
Signature · 1 line
2.18.0
Hi Daniel,
Just gentle ping. Many thanks.
Quoted 247 lines · Michael Kao
From: Louis Yu <[email protected]>
Add suspend/resume callback to disable/enable Mediatek thermal sensor respectively. Since thermal power domain is off in suspend, thermal driver needs re-initialization during resume.
Signed-off-by Louis Yu <[email protected]>Signed-off-by Michael Kao <[email protected]>--- drivers/thermal/mtk_thermal.c | 134 +++++++++++++++++++++++++++++++--- 1 file changed, 125 insertions(+), 9 deletions(-)drivers/thermal/mtk_thermal.c +125
-9@@ -22,6 +22,7 @@#include <linux/thermal.h> #include <linux/reset.h> #include <linux/types.h> +#include <linux/iopoll.h> /* AUXADC Registers */ #define AUXADC_CON1_SET_V 0x008@@ -31,6 +32,8 @@#define APMIXED_SYS_TS_CON1 0x604 +#define APMIXED_SYS_TS_CON1_BUFFER_OFF 0x30 +/* Thermal Controller Registers */ #define TEMP_MONCTL0 0x000#define TEMP_MONCTL1 0x004@@ -38,6 +41,7 @@#define TEMP_MONIDET0 0x014#define TEMP_MONIDET1 0x018#define TEMP_MSRCTL0 0x038 +#define TEMP_MSRCTL1 0x03c#define TEMP_AHBPOLL 0x040#define TEMP_AHBTO 0x044#define TEMP_ADCPNP0 0x048@@ -87,6 +91,9 @@#define TEMP_ADCVALIDMASK_VALID_HIGH BIT(5)#define TEMP_ADCVALIDMASK_VALID_POS (bit) (bit) +#define TEMP_MSRCTL1_BUS_STA (BIT(0) | BIT(7)) +#define TEMP_MSRCTL1_SENSING_POINTS_PAUSE 0x10E +/* MT8173 thermal sensors */ #define MT8173_TS1 0#define MT8173_TS2 1@@ -250,6 +257,10 @@ struct mtk_thermal_data {struct mtk_thermal {struct device *dev;void __iomem *thermal_base; +void __iomem *apmixed_base; +void __iomem *auxadc_base; +u64 apmixed_phys_base; +u64 auxadc_phys_base;struct clk *clk_peri_therm;struct clk *clk_auxadc;@@ -746,6 +757,42 @@ static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num,mtk_thermal_put_bank (bank); } +static int mtk_thermal_disable_sensing (struct mtk_thermal *mt,int num) +{ +struct mtk_thermal_bank *bank = &mt->banks[num]; +u32 val; +unsigned long timeout; +void __iomem *addr; +int ret =0 ; + + bank->id = num; + bank->mt = mt; + +mtk_thermal_get_bank (bank); + + val =readl (mt->thermal_base +TEMP_MSRCTL1 ); +/* pause periodic temperature measurement for sensing points */ +writel (val |TEMP_MSRCTL1_SENSING_POINTS_PAUSE , + mt->thermal_base +TEMP_MSRCTL1 ); + +/* wait until temperature measurement bus idle */ + timeout = jiffies +HZ ; + addr = mt->thermal_base +TEMP_MSRCTL1 ; + + ret =readl_poll_timeout (addr, val, (val &TEMP_MSRCTL1_BUS_STA ) ==0x0 , +0 , timeout); +if (ret <0 ) + goto out; + +/* disable periodic temperature meausrement on sensing points */ +writel (0x0 , mt->thermal_base +TEMP_MONCTL0 ); + +out: +mtk_thermal_put_bank (bank); + +return ret; +} +static u64 of_get_phys_base (struct device_node *np) {u64 size64;@@ -868,7 +915,6 @@ static int mtk_thermal_probe(struct platform_device *pdev)struct device_node *auxadc, *apmixedsys, *np = pdev->dev.of_node;struct mtk_thermal *mt;struct resource *res; -u64 auxadc_phys_base, apmixed_phys_base;struct thermal_zone_device *tzdev; mt =devm_kzalloc (&pdev->dev,sizeof (*mt),GFP_KERNEL );@@ -904,11 +950,11 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - auxadc_phys_base =of_get_phys_base (auxadc); + mt->auxadc_phys_base =of_get_phys_base (auxadc);of_node_put (auxadc); -if (auxadc_phys_base ==OF_BAD_ADDR ) { +if (mt->auxadc_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }@@ -919,11 +965,12 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_base =of_iomap (apmixedsys,0 );of_node_put (apmixedsys); -if (apmixed_phys_base ==OF_BAD_ADDR ) { +if (mt->apmixed_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }@@ -935,19 +982,19 @@ static int mtk_thermal_probe(struct platform_device *pdev) ret =clk_prepare_enable (mt->clk_auxadc);if (ret) {dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); -return ret; + goto err_disable_clk_auxadc; } ret =clk_prepare_enable (mt->clk_peri_therm);if (ret) {dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); - goto err_disable_clk_auxadc; + goto err_disable_clk_peri_therm; }for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++)for (i =0 ; i < mt->conf->num_banks; i++) -mtk_thermal_init_bank (mt, i, apmixed_phys_base, - auxadc_phys_base, ctrl_id); +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id);platform_set_drvdata (pdev, mt);@@ -978,11 +1025,80 @@ static int mtk_thermal_remove(struct platform_device *pdev)return 0 ; } +static int __maybe_unused mtk_thermal_suspend (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret; + +for (i =0 ; i < mt->conf->num_banks; i++) { + ret =mtk_thermal_disable_sensing (mt, i); +if (ret) + goto out; + } + +/* disable buffer */ +writel (readl (mt->apmixed_base +APMIXED_SYS_TS_CON1 ) | +APMIXED_SYS_TS_CON1_BUFFER_OFF , + mt->apmixed_base +APMIXED_SYS_TS_CON1 ); + +clk_disable_unprepare (mt->clk_peri_therm); +clk_disable_unprepare (mt->clk_auxadc); + +return 0 ; + +out: +dev_err (&pdev->dev,"Failed to wait until bus idle\n" ); + +return ret; +} + +static int __maybe_unused mtk_thermal_resume (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret, ctrl_id; + + ret =device_reset (&pdev->dev); +if (ret) +return ret; + + ret =clk_prepare_enable (mt->clk_auxadc); +if (ret) { +dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); + goto err_disable_clk_auxadc; + } + + ret =clk_prepare_enable (mt->clk_peri_therm); +if (ret) { +dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); + goto err_disable_clk_peri_therm; + } + +for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++) +for (i =0 ; i < mt->conf->num_banks; i++) +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id); + +return 0 ; + +err_disable_clk_peri_therm: +clk_disable_unprepare (mt->clk_peri_therm); +err_disable_clk_auxadc: +clk_disable_unprepare (mt->clk_auxadc); + +return ret; +} + +static SIMPLE_DEV_PM_OPS(mtk_thermal_pm_ops, + mtk_thermal_suspend, mtk_thermal_resume); +static struct platform_driver mtk_thermal_driver = { .probe = mtk_thermal_probe, .remove = mtk_thermal_remove, .driver = { .name ="mtk-thermal" , + .pm = &mtk_thermal_pm_ops, .of_match_table = mtk_thermal_of_match, }, };
Quoted 66 lines · Michael Kao
From: Louis Yu <[email protected]>
Add suspend/resume callback to disable/enable Mediatek thermal sensor respectively. Since thermal power domain is off in suspend, thermal driver needs re-initialization during resume.
Signed-off-by Louis Yu <[email protected]>Signed-off-by Michael Kao <[email protected]>--- drivers/thermal/mtk_thermal.c | 134 +++++++++++++++++++++++++++++++--- 1 file changed, 125 insertions(+), 9 deletions(-)drivers/thermal/mtk_thermal.c +11
-0@@ -22,6 +22,7 @@#include <linux/thermal.h> #include <linux/reset.h> #include <linux/types.h> +#include <linux/iopoll.h> /* AUXADC Registers */ #define AUXADC_CON1_SET_V 0x008@@ -31,6 +32,8 @@#define APMIXED_SYS_TS_CON1 0x604 +#define APMIXED_SYS_TS_CON1_BUFFER_OFF 0x30 +/* Thermal Controller Registers */ #define TEMP_MONCTL0 0x000#define TEMP_MONCTL1 0x004@@ -38,6 +41,7 @@#define TEMP_MONIDET0 0x014#define TEMP_MONIDET1 0x018#define TEMP_MSRCTL0 0x038 +#define TEMP_MSRCTL1 0x03c#define TEMP_AHBPOLL 0x040#define TEMP_AHBTO 0x044#define TEMP_ADCPNP0 0x048@@ -87,6 +91,9 @@#define TEMP_ADCVALIDMASK_VALID_HIGH BIT(5)#define TEMP_ADCVALIDMASK_VALID_POS (bit) (bit) +#define TEMP_MSRCTL1_BUS_STA (BIT(0) | BIT(7)) +#define TEMP_MSRCTL1_SENSING_POINTS_PAUSE 0x10E +/* MT8173 thermal sensors */ #define MT8173_TS1 0#define MT8173_TS2 1@@ -250,6 +257,10 @@ struct mtk_thermal_data {struct mtk_thermal {struct device *dev;void __iomem *thermal_base; +void __iomem *apmixed_base; +void __iomem *auxadc_base; +u64 apmixed_phys_base; +u64 auxadc_phys_base;struct clk *clk_peri_therm;struct clk *clk_auxadc;@@ -746,6 +757,42 @@ static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num,mtk_thermal_put_bank (bank); }
drivers/thermal/mtk_thermal.c static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num, · line 769
Quoted 10 lines
drivers/thermal/mtk_thermal.c +10
-0+static int mtk_thermal_disable_sensing (struct mtk_thermal *mt,int num) +{ +struct mtk_thermal_bank *bank = &mt->banks[num]; +u32 val; +unsigned long timeout; +void __iomem *addr; +int ret =0 ; + + bank->id = num; + bank->mt = mt;
Can you explain why this is done?
drivers/thermal/mtk_thermal.c static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num, · line 771
Quoted 1 line
drivers/thermal/mtk_thermal.c +1
-0+mtk_thermal_get_bank (bank);
I'm not comfortable with this call. The underlying code is calling mutex_lock, I suspect it can potentially deadlock the board.
Why do you need a mutex? Isn't a spin_lock enough?
Please take also the opportunity to rename to lock_bank / unlock_bank. get and put are usually for refcounting.
Quoted 5 lines
drivers/thermal/mtk_thermal.c +5
-0+ val =readl (mt->thermal_base +TEMP_MSRCTL1 ); +/* pause periodic temperature measurement for sensing points */ +writel (val |TEMP_MSRCTL1_SENSING_POINTS_PAUSE , + mt->thermal_base +TEMP_MSRCTL1 ); +
drivers/thermal/mtk_thermal.c static void mtk_thermal_init_bank(struct mtk_thermal *mt, int num, · line 787
Quoted 10 lines
drivers/thermal/mtk_thermal.c +10
-0+/* wait until temperature measurement bus idle */ + timeout = jiffies +HZ ; + addr = mt->thermal_base +TEMP_MSRCTL1 ; + + ret =readl_poll_timeout (addr, val, (val &TEMP_MSRCTL1_BUS_STA ) ==0x0 , +0 , timeout); +if (ret <0 ) + goto out; + +/* disable periodic temperature meausrement on sensing points */
s/meausrement/measurement/
Quoted 154 lines
drivers/thermal/mtk_thermal.c +86
-9+writel (0x0 , mt->thermal_base +TEMP_MONCTL0 ); + +out: +mtk_thermal_put_bank (bank); + +return ret; +} +static u64 of_get_phys_base (struct device_node *np) {u64 size64;@@ -868,7 +915,6 @@ static int mtk_thermal_probe(struct platform_device *pdev)struct device_node *auxadc, *apmixedsys, *np = pdev->dev.of_node;struct mtk_thermal *mt;struct resource *res; -u64 auxadc_phys_base, apmixed_phys_base;struct thermal_zone_device *tzdev; mt =devm_kzalloc (&pdev->dev,sizeof (*mt),GFP_KERNEL );@@ -904,11 +950,11 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - auxadc_phys_base =of_get_phys_base (auxadc); + mt->auxadc_phys_base =of_get_phys_base (auxadc);of_node_put (auxadc); -if (auxadc_phys_base ==OF_BAD_ADDR ) { +if (mt->auxadc_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }@@ -919,11 +965,12 @@ static int mtk_thermal_probe(struct platform_device *pdev)return -ENODEV ; } - apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_phys_base =of_get_phys_base (apmixedsys); + mt->apmixed_base =of_iomap (apmixedsys,0 );of_node_put (apmixedsys); -if (apmixed_phys_base ==OF_BAD_ADDR ) { +if (mt->apmixed_phys_base ==OF_BAD_ADDR ) {dev_err (&pdev->dev,"Can't get auxadc phys address\n" );return -EINVAL ; }@@ -935,19 +982,19 @@ static int mtk_thermal_probe(struct platform_device *pdev) ret =clk_prepare_enable (mt->clk_auxadc);if (ret) {dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); -return ret; + goto err_disable_clk_auxadc; } ret =clk_prepare_enable (mt->clk_peri_therm);if (ret) {dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); - goto err_disable_clk_auxadc; + goto err_disable_clk_peri_therm; }for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++)for (i =0 ; i < mt->conf->num_banks; i++) -mtk_thermal_init_bank (mt, i, apmixed_phys_base, - auxadc_phys_base, ctrl_id); +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id);platform_set_drvdata (pdev, mt);@@ -978,11 +1025,80 @@ static int mtk_thermal_remove(struct platform_device *pdev)return 0 ; } +static int __maybe_unused mtk_thermal_suspend (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret; + +for (i =0 ; i < mt->conf->num_banks; i++) { + ret =mtk_thermal_disable_sensing (mt, i); +if (ret) + goto out; + } + +/* disable buffer */ +writel (readl (mt->apmixed_base +APMIXED_SYS_TS_CON1 ) | +APMIXED_SYS_TS_CON1_BUFFER_OFF , + mt->apmixed_base +APMIXED_SYS_TS_CON1 ); + +clk_disable_unprepare (mt->clk_peri_therm); +clk_disable_unprepare (mt->clk_auxadc); + +return 0 ; + +out: +dev_err (&pdev->dev,"Failed to wait until bus idle\n" ); + +return ret; +} + +static int __maybe_unused mtk_thermal_resume (struct device *dev) +{ +struct platform_device *pdev =to_platform_device (dev); +struct mtk_thermal *mt =platform_get_drvdata (pdev); +int i, ret, ctrl_id; + + ret =device_reset (&pdev->dev); +if (ret) +return ret; + + ret =clk_prepare_enable (mt->clk_auxadc); +if (ret) { +dev_err (&pdev->dev,"Can't enable auxadc clk: %d\n" , ret); + goto err_disable_clk_auxadc; + } + + ret =clk_prepare_enable (mt->clk_peri_therm); +if (ret) { +dev_err (&pdev->dev,"Can't enable peri clk: %d\n" , ret); + goto err_disable_clk_peri_therm; + } + +for (ctrl_id =0 ; ctrl_id < mt->conf->num_controller ; ctrl_id++) +for (i =0 ; i < mt->conf->num_banks; i++) +mtk_thermal_init_bank (mt, i, mt->apmixed_phys_base, + mt->auxadc_phys_base, ctrl_id); + +return 0 ; + +err_disable_clk_peri_therm: +clk_disable_unprepare (mt->clk_peri_therm); +err_disable_clk_auxadc: +clk_disable_unprepare (mt->clk_auxadc); + +return ret; +} + +static SIMPLE_DEV_PM_OPS(mtk_thermal_pm_ops, + mtk_thermal_suspend, mtk_thermal_resume); +static struct platform_driver mtk_thermal_driver = { .probe = mtk_thermal_probe, .remove = mtk_thermal_remove, .driver = { .name ="mtk-thermal" , + .pm = &mtk_thermal_pm_ops, .of_match_table = mtk_thermal_of_match, }, };
Signature · 5 lines
<http://www.linaro.org/> Linaro.org │ Open source software for ARM SoCs Follow Linaro: <http://www.facebook.com/pages/Linaro> Facebook | <http://twitter.com/#!/linaroorg> Twitter | <http://www.linaro.org/linaro-blog/> Blog