Skip to content

Commit

Permalink
thermal/drivers/hisi: Prepare to add support for other hisi platforms
Browse files Browse the repository at this point in the history 
For platform compatibility, add the tsensor ops to a thermal data
structure. Each platform has its own probe function to register proper
tsensor ops function to the pointer, platform related resource request
are also implemented in the platform probe function.

Signed-off-by: Kevin Wangtao <kevin.wangtao@linaro.org>
Tested-by: Daniel Lezcano <daniel.lezcano@linaro.org> # hikey6220
Signed-off-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Signed-off-by: Eduardo Valentin <edubezval@gmail.com>
  • Loading branch information
Kevin Wangtao authored and Eduardo Valentin committed Nov 1, 2017
1 parent 5ed82b7 commit a160a46
Showing 1 changed file with 87 additions and 45 deletions.
132 changes: 87 additions & 45 deletions drivers/thermal/hisi_thermal.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -23,14 +23,15 @@
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/io.h>
#include <linux/of_device.h>

#include "thermal_core.h"

#define HI6220_TEMP0_LAG (0x0)
#define HI6220_TEMP0_TH (0x4)
#define HI6220_TEMP0_RST_TH (0x8)
#define HI6220_TEMP0_CFG (0xC)
#define HI6220_TEMP0_CFG_SS_MSK (0xF000)
#define HI6220_TEMP0_CFG_SS_MSK (0xF000)
#define HI6220_TEMP0_CFG_HDAK_MSK (0x30)
#define HI6220_TEMP0_EN (0x10)
#define HI6220_TEMP0_INT_EN (0x14)
Expand All @@ -41,7 +42,7 @@
#define HI6220_TEMP_BASE (-60000)
#define HI6220_TEMP_RESET (100000)
#define HI6220_TEMP_STEP (785)
#define HI6220_TEMP_LAG (3500)
#define HI6220_TEMP_LAG (3500)

#define HI6220_DEFAULT_SENSOR 2

Expand All @@ -52,6 +53,10 @@ struct hisi_thermal_sensor {
};

struct hisi_thermal_data {
int (*get_temp)(struct hisi_thermal_data *data);
int (*enable_sensor)(struct hisi_thermal_data *data);
int (*disable_sensor)(struct hisi_thermal_data *data);
int (*irq_handler)(struct hisi_thermal_data *data);
struct platform_device *pdev;
struct clk *clk;
struct hisi_thermal_sensor sensor;
Expand Down Expand Up @@ -192,14 +197,27 @@ static inline void hi6220_thermal_hdak_set(void __iomem *addr, int value)
(value << 4), addr + HI6220_TEMP0_CFG);
}

static void hi6220_thermal_disable_sensor(struct hisi_thermal_data *data)
static int hi6220_thermal_irq_handler(struct hisi_thermal_data *data)
{
hi6220_thermal_alarm_clear(data->regs, 1);
return 0;
}

static int hi6220_thermal_get_temp(struct hisi_thermal_data *data)
{
return hi6220_thermal_get_temperature(data->regs);
}

static int hi6220_thermal_disable_sensor(struct hisi_thermal_data *data)
{
/* disable sensor module */
hi6220_thermal_enable(data->regs, 0);
hi6220_thermal_alarm_enable(data->regs, 0);
hi6220_thermal_reset_enable(data->regs, 0);

clk_disable_unprepare(data->clk);

return 0;
}

static int hi6220_thermal_enable_sensor(struct hisi_thermal_data *data)
Expand Down Expand Up @@ -240,12 +258,48 @@ static int hi6220_thermal_enable_sensor(struct hisi_thermal_data *data)
return 0;
}

static int hi6220_thermal_probe(struct hisi_thermal_data *data)
{
struct platform_device *pdev = data->pdev;
struct device *dev = &pdev->dev;
struct resource *res;
int ret;

data->get_temp = hi6220_thermal_get_temp;
data->enable_sensor = hi6220_thermal_enable_sensor;
data->disable_sensor = hi6220_thermal_disable_sensor;
data->irq_handler = hi6220_thermal_irq_handler;

res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
data->regs = devm_ioremap_resource(dev, res);
if (IS_ERR(data->regs)) {
dev_err(dev, "failed to get io address\n");
return PTR_ERR(data->regs);
}

data->clk = devm_clk_get(dev, "thermal_clk");
if (IS_ERR(data->clk)) {
ret = PTR_ERR(data->clk);
if (ret != -EPROBE_DEFER)
dev_err(dev, "failed to get thermal clk: %d\n", ret);
return ret;
}

data->irq = platform_get_irq(pdev, 0);
if (data->irq < 0)
return data->irq;

data->sensor.id = HI6220_DEFAULT_SENSOR;

return 0;
}

static int hisi_thermal_get_temp(void *__data, int *temp)
{
struct hisi_thermal_data *data = __data;
struct hisi_thermal_sensor *sensor = &data->sensor;

*temp = hi6220_thermal_get_temperature(data->regs);
*temp = data->get_temp(data);

dev_dbg(&data->pdev->dev, "id=%d, temp=%d, thres=%d\n",
sensor->id, *temp, sensor->thres_temp);
Expand All @@ -263,7 +317,7 @@ static irqreturn_t hisi_thermal_alarm_irq_thread(int irq, void *dev)
struct hisi_thermal_sensor *sensor = &data->sensor;
int temp = 0;

hi6220_thermal_alarm_clear(data->regs, 1);
data->irq_handler(data);

hisi_thermal_get_temp(data, &temp);

Expand All @@ -284,14 +338,11 @@ static irqreturn_t hisi_thermal_alarm_irq_thread(int irq, void *dev)

static int hisi_thermal_register_sensor(struct platform_device *pdev,
struct hisi_thermal_data *data,
struct hisi_thermal_sensor *sensor,
int index)
struct hisi_thermal_sensor *sensor)
{
int ret, i;
const struct thermal_trip *trip;

sensor->id = index;

sensor->tzd = devm_thermal_zone_of_sensor_register(&pdev->dev,
sensor->id, data,
&hisi_of_thermal_ops);
Expand All @@ -316,7 +367,7 @@ static int hisi_thermal_register_sensor(struct platform_device *pdev,
}

static const struct of_device_id of_hisi_thermal_match[] = {
{ .compatible = "hisilicon,tsensor" },
{ .compatible = "hisilicon,tsensor", .data = hi6220_thermal_probe },
{ /* end */ }
};
MODULE_DEVICE_TABLE(of, of_hisi_thermal_match);
Expand All @@ -333,58 +384,48 @@ static void hisi_thermal_toggle_sensor(struct hisi_thermal_sensor *sensor,
static int hisi_thermal_probe(struct platform_device *pdev)
{
struct hisi_thermal_data *data;
struct resource *res;
int const (*platform_probe)(struct hisi_thermal_data *);
struct device *dev = &pdev->dev;
int ret;

data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
if (!data)
return -ENOMEM;

data->pdev = pdev;
platform_set_drvdata(pdev, data);

res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
data->regs = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(data->regs)) {
dev_err(&pdev->dev, "failed to get io address\n");
return PTR_ERR(data->regs);
platform_probe = of_device_get_match_data(dev);
if (!platform_probe) {
dev_err(dev, "failed to get probe func\n");
return -EINVAL;
}

data->irq = platform_get_irq(pdev, 0);
if (data->irq < 0)
return data->irq;

platform_set_drvdata(pdev, data);

data->clk = devm_clk_get(&pdev->dev, "thermal_clk");
if (IS_ERR(data->clk)) {
ret = PTR_ERR(data->clk);
if (ret != -EPROBE_DEFER)
dev_err(&pdev->dev,
"failed to get thermal clk: %d\n", ret);
ret = platform_probe(data);
if (ret)
return ret;
}

ret = hisi_thermal_register_sensor(pdev, data,
&data->sensor,
HI6220_DEFAULT_SENSOR);
&data->sensor);
if (ret) {
dev_err(&pdev->dev, "failed to register thermal sensor: %d\n",
ret);
dev_err(dev, "failed to register thermal sensor: %d\n", ret);
return ret;
}

ret = hi6220_thermal_enable_sensor(data);
ret = data->enable_sensor(data);
if (ret) {
dev_err(&pdev->dev, "Failed to setup the sensor: %d\n", ret);
dev_err(dev, "Failed to setup the sensor: %d\n", ret);
return ret;
}

ret = devm_request_threaded_irq(&pdev->dev, data->irq, NULL,
hisi_thermal_alarm_irq_thread,
IRQF_ONESHOT, "hisi_thermal", data);
if (ret < 0) {
dev_err(&pdev->dev, "failed to request alarm irq: %d\n", ret);
return ret;
if (data->irq) {
ret = devm_request_threaded_irq(dev, data->irq, NULL,
hisi_thermal_alarm_irq_thread,
IRQF_ONESHOT, "hisi_thermal", data);
if (ret < 0) {
dev_err(dev, "failed to request alarm irq: %d\n", ret);
return ret;
}
}

hisi_thermal_toggle_sensor(&data->sensor, true);
Expand All @@ -398,7 +439,8 @@ static int hisi_thermal_remove(struct platform_device *pdev)
struct hisi_thermal_sensor *sensor = &data->sensor;

hisi_thermal_toggle_sensor(sensor, false);
hi6220_thermal_disable_sensor(data);

data->disable_sensor(data);

return 0;
}
Expand All @@ -408,7 +450,7 @@ static int hisi_thermal_suspend(struct device *dev)
{
struct hisi_thermal_data *data = dev_get_drvdata(dev);

hi6220_thermal_disable_sensor(data);
data->disable_sensor(data);

return 0;
}
Expand All @@ -417,7 +459,7 @@ static int hisi_thermal_resume(struct device *dev)
{
struct hisi_thermal_data *data = dev_get_drvdata(dev);

return hi6220_thermal_enable_sensor(data);
return data->enable_sensor(data);
}
#endif

Expand Down

0 comments on commit a160a46

Please sign in to comment.