[Nouveau] [RFC] nouveau: Add basic i2c sensor chip support
Matthew Garrett
mjg59 at srcf.ucam.org
Fri Nov 20 10:43:25 PST 2009
This one works better, including some amount of support for the internal
GPU sensor. It seems to give reasonable results on all the cards I have
here.
diff --git a/drivers/gpu/drm/nouveau/Makefile b/drivers/gpu/drm/nouveau/Makefile
index e12b4ff..3296739 100644
--- a/drivers/gpu/drm/nouveau/Makefile
+++ b/drivers/gpu/drm/nouveau/Makefile
@@ -9,6 +9,7 @@ nouveau-y := nouveau_drv.o nouveau_state.o nouveau_channel.o nouveau_mem.o \
nouveau_bo.o nouveau_fence.o nouveau_gem.o nouveau_ttm.o \
nouveau_hw.o nouveau_calc.o nouveau_bios.o nouveau_i2c.o \
nouveau_display.o nouveau_connector.o nouveau_fbcon.o \
+ nouveau_thermal.o \
nv04_timer.o \
nv04_mc.o nv40_mc.o nv50_mc.o \
nv04_fb.o nv10_fb.o nv40_fb.o \
diff --git a/drivers/gpu/drm/nouveau/nouveau_bios.c b/drivers/gpu/drm/nouveau/nouveau_bios.c
index 1079508..80d3a43 100644
--- a/drivers/gpu/drm/nouveau/nouveau_bios.c
+++ b/drivers/gpu/drm/nouveau/nouveau_bios.c
@@ -4531,6 +4531,60 @@ static int parse_bit_M_tbl_entry(struct drm_device *dev, struct nvbios *bios, st
return 0;
}
+static int parse_bit_temp_tbl_entry(struct drm_device *dev, struct nvbios *bios, uint16_t tbl_ptr)
+{
+ uint8_t version, headerlen, entrylen, num_entries;
+ uint16_t offset = tbl_ptr;
+ int i;
+
+ bios->sensor.diode_offset_mult = -1;
+ bios->sensor.diode_offset_div = -1;
+ bios->sensor.slope_mult = -1;
+ bios->sensor.slope_div = -1;
+
+ version = bios->data[tbl_ptr];
+ headerlen = bios->data[tbl_ptr+1];
+ entrylen = bios->data[tbl_ptr+2];
+ num_entries = bios->data[tbl_ptr+3];
+
+ offset += headerlen;
+
+ for (i = 0; i < num_entries; i++) {
+ uint8_t id = bios->data[offset+entrylen*i];
+ int16_t val = ROM16(bios->data[offset+1+entrylen*i]);
+
+ switch (id) {
+ case 0x1:
+ if ((val & 0x8f) == 0)
+ bios->sensor.temp_correction =
+ ((val >> 9) & 0x7f);
+ break;
+ case 0x10:
+ bios->sensor.diode_offset_mult = val;
+ break;
+ case 0x11:
+ bios->sensor.diode_offset_div = val;
+ break;
+ case 0x12:
+ bios->sensor.slope_mult = val;
+ break;
+ case 0x13:
+ bios->sensor.slope_div = val;
+ break;
+ }
+ }
+ return 0;
+}
+
+static int parse_bit_performance_tbl_entry(struct drm_device *dev, struct nvbios *bios, struct bit_entry *bitentry)
+{
+ uint16_t temp_tbl_ptr = ROM16(bios->data[bitentry->offset + 0xc]);
+
+ parse_bit_temp_tbl_entry(dev, bios, temp_tbl_ptr);
+
+ return 0;
+}
+
static int parse_bit_tmds_tbl_entry(struct drm_device *dev, struct nvbios *bios, struct bit_entry *bitentry)
{
/*
@@ -4675,6 +4729,7 @@ static int parse_bit_structure(struct drm_device *dev, struct nvbios *bios,
parse_bit_table(dev, bios, bitoffset, &BIT_TABLE('L', lvds));
parse_bit_table(dev, bios, bitoffset, &BIT_TABLE('T', tmds));
parse_bit_table(dev, bios, bitoffset, &BIT_TABLE('U', U));
+ parse_bit_table(dev, bios, bitoffset, &BIT_TABLE('P', performance));
return 0;
}
@@ -5252,6 +5307,7 @@ static int parse_dcb_table(struct drm_device *dev, struct nvbios *bios, bool two
{
struct bios_parsed_dcb *bdcb = &bios->bdcb;
struct parsed_dcb *dcb;
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
uint16_t dcbptr, i2ctabptr = 0;
uint8_t *dcbtable;
uint8_t headerlen = 0x4, entries = DCB_MAX_NUM_ENTRIES;
@@ -5357,8 +5413,19 @@ static int parse_dcb_table(struct drm_device *dev, struct nvbios *bios, bool two
NV_WARN(dev, "No pointer to DCB I2C port table\n");
else {
bdcb->i2c_table = &bios->data[i2ctabptr];
- if (bdcb->version >= 0x30)
+ if (bdcb->version >= 0x30) {
+ int address;
+
bdcb->i2c_default_indices = bdcb->i2c_table[4];
+
+ if (dev_priv->card_type < NV_50)
+ address = 0x2;
+ else
+ address = bdcb->i2c_default_indices & 0xf;
+
+ read_dcb_i2c_entry(dev, bdcb->version, bdcb->i2c_table,
+ address, &bdcb->management_i2c);
+ }
}
if (entries > DCB_MAX_NUM_ENTRIES)
diff --git a/drivers/gpu/drm/nouveau/nouveau_bios.h b/drivers/gpu/drm/nouveau/nouveau_bios.h
index 1ffda97..e92f3d9 100644
--- a/drivers/gpu/drm/nouveau/nouveau_bios.h
+++ b/drivers/gpu/drm/nouveau/nouveau_bios.h
@@ -77,6 +77,7 @@ struct bios_parsed_dcb {
uint16_t init8e_table_ptr;
uint8_t *i2c_table;
uint8_t i2c_default_indices;
+ struct dcb_i2c_entry management_i2c;
};
enum nouveau_encoder_type {
@@ -231,6 +232,15 @@ struct nvbios {
uint16_t lvds_single_a_script_ptr;
} legacy;
+
+ struct {
+ int32_t slope_div;
+ int32_t slope_mult;
+ int32_t diode_offset_div;
+ int32_t diode_offset_mult;
+ int32_t temp_correction;
+ } sensor;
+
};
#endif
diff --git a/drivers/gpu/drm/nouveau/nouveau_drv.h b/drivers/gpu/drm/nouveau/nouveau_drv.h
index e33fdd3..bf0330e 100644
--- a/drivers/gpu/drm/nouveau/nouveau_drv.h
+++ b/drivers/gpu/drm/nouveau/nouveau_drv.h
@@ -581,6 +581,9 @@ struct drm_nouveau_private {
struct backlight_device *backlight;
bool acpi_dsm;
+ struct device *hwmon_dev;
+ int (*get_gpu_temperature)(struct drm_device *dev);
+
struct nouveau_channel *evo;
struct {
diff --git a/drivers/gpu/drm/nouveau/nouveau_reg.h b/drivers/gpu/drm/nouveau/nouveau_reg.h
index 3a5f43a..2db408f 100644
--- a/drivers/gpu/drm/nouveau/nouveau_reg.h
+++ b/drivers/gpu/drm/nouveau/nouveau_reg.h
@@ -99,6 +99,8 @@
* the card will hang early on in the X init process.
*/
# define NV_PMC_ENABLE_UNK13 (1<<13)
+#define NV40_PMC_TEMP_DATA 0x000015b0
+#define NV40_PMC_TEMP_VALUE 0x000015b4
#define NV40_PMC_BACKLIGHT 0x000015f0
# define NV40_PMC_BACKLIGHT_MASK 0x001f0000
#define NV40_PMC_1700 0x00001700
diff --git a/drivers/gpu/drm/nouveau/nouveau_state.c b/drivers/gpu/drm/nouveau/nouveau_state.c
index ac29298..3a3a2de 100644
--- a/drivers/gpu/drm/nouveau/nouveau_state.c
+++ b/drivers/gpu/drm/nouveau/nouveau_state.c
@@ -32,6 +32,7 @@
#include "nouveau_drv.h"
#include "nouveau_drm.h"
#include "nv50_display.h"
+#include "nouveau_thermal.h"
static int nouveau_stub_init(struct drm_device *dev) { return 0; }
static void nouveau_stub_takedown(struct drm_device *dev) {}
@@ -434,8 +435,10 @@ nouveau_card_init(struct drm_device *dev)
dev_priv->init_state = NOUVEAU_CARD_INIT_DONE;
- if (drm_core_check_feature(dev, DRIVER_MODESET))
+ if (drm_core_check_feature(dev, DRIVER_MODESET)) {
drm_helper_initial_config(dev);
+ nouveau_thermal_init(dev);
+ }
return 0;
}
@@ -470,8 +473,10 @@ static void nouveau_card_takedown(struct drm_device *dev)
nouveau_mem_close(dev);
engine->instmem.takedown(dev);
- if (drm_core_check_feature(dev, DRIVER_MODESET))
+ if (drm_core_check_feature(dev, DRIVER_MODESET)) {
+ nouveau_thermal_exit(dev);
drm_irq_uninstall(dev);
+ }
nouveau_gpuobj_late_takedown(dev);
nouveau_bios_takedown(dev);
diff --git a/drivers/gpu/drm/nouveau/nouveau_thermal.c b/drivers/gpu/drm/nouveau/nouveau_thermal.c
new file mode 100644
index 0000000..6c017d5
--- /dev/null
+++ b/drivers/gpu/drm/nouveau/nouveau_thermal.c
@@ -0,0 +1,326 @@
+/*
+ * Copyright 2009 Red Hat Inc <mjg at redhat.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * 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.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA
+ *
+ * Contains code derived from nvclock (http://nvclock.sourceforge.net)
+ *
+ * nvclock code is:
+ * Copyright(C) 2001-2007 Roderick Colenbrander
+ * Copyright(C) 2005 Hans-Frieder Vogt
+ */
+
+#include "drmP.h"
+#include "drm.h"
+#include "nouveau_drv.h"
+#include "nouveau_drm.h"
+#include "nouveau_i2c.h"
+#include <linux/hwmon.h>
+#include <linux/hwmon-sysfs.h>
+
+static int nouveau_thermal_nv40_setup_sensor(struct drm_device *dev)
+{
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
+ struct nvbios *bios = &dev_priv->VBIOS;
+ int offset_mult, offset_div, slope_mult, slope_div, temp;
+ int offset = 0;
+ int correction = bios->sensor.temp_correction;
+
+ /*
+ * If we didn't get values from the BIOS then we need to use some
+ * default values. Set these up.
+ */
+
+ switch (dev_priv->chipset) {
+ case 0x43:
+ offset_mult = 32060;
+ offset_div = 1000;
+ slope_mult = 792;
+ slope_div = 1000;
+ break;
+ case 0x44:
+ case 0x47:
+ offset_mult = 27839;
+ offset_div = 1000;
+ slope_mult = 780;
+ slope_div = 1000;
+ break;
+ case 0x46:
+ offset_mult = -24775;
+ offset_div = 100;
+ slope_mult = 467;
+ slope_div = 10000;
+ break;
+ case 0x49:
+ offset_mult = -25051;
+ offset_div = 100;
+ slope_mult = 458;
+ slope_div = 10000;
+ break;
+ case 0x4b:
+ offset_mult = -24088;
+ offset_div = 100;
+ slope_mult = 442;
+ slope_div = 10000;
+ break;
+ }
+ if (bios->sensor.diode_offset_mult == -1)
+ bios->sensor.diode_offset_mult = offset_mult;
+ if (bios->sensor.diode_offset_div == -1)
+ bios->sensor.diode_offset_div = offset_div;
+ if (bios->sensor.slope_mult == -1)
+ bios->sensor.slope_mult = slope_mult;
+ if (bios->sensor.slope_div == -1)
+ bios->sensor.slope_div = slope_div;
+
+ if (dev_priv->chipset >= 0x46)
+ temp = nv_rd32(dev, NV40_PMC_TEMP_VALUE) & 0x1fff;
+ else
+ temp = nv_rd32(dev, NV40_PMC_TEMP_VALUE) & 0xfff;
+
+ if (bios->sensor.diode_offset_div)
+ offset = bios->sensor.diode_offset_mult /
+ bios->sensor.diode_offset_div;
+
+ if ((temp & 0xfff) == 0) {
+ /* Set up the sensor */
+ int max_temp;
+
+ if (bios->sensor.slope_mult)
+ max_temp = (120 - offset - correction) *
+ bios->sensor.slope_div /
+ bios->sensor.slope_mult;
+ else
+ max_temp = 120 - offset - correction;
+
+ if (dev_priv->chipset >= 0x46)
+ nv_wr32(dev, NV40_PMC_TEMP_DATA,
+ max_temp | 0x80000000);
+ else
+ nv_wr32(dev, NV40_PMC_TEMP_DATA,
+ max_temp | 0x10000000);
+ msleep(5);
+ }
+
+ /* If we fail here, there's probably no sensor */
+ temp = nv_rd32(dev, NV40_PMC_TEMP_VALUE) & 0xfff;
+
+ if (!temp)
+ return -ENODEV;
+
+ return 0;
+}
+
+static int nouveau_thermal_nv40_read_temp(struct drm_device *dev)
+{
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
+ struct nvbios *bios = &dev_priv->VBIOS;
+ int temp;
+ int correction = bios->sensor.temp_correction;
+ int offset = 0;
+
+ if (dev_priv->chipset >= 0x46)
+ temp = nv_rd32(dev, NV40_PMC_TEMP_VALUE) & 0x1fff;
+ else
+ temp = nv_rd32(dev, NV40_PMC_TEMP_VALUE) & 0xfff;
+
+ if (bios->sensor.diode_offset_div)
+ offset = bios->sensor.diode_offset_mult /
+ bios->sensor.diode_offset_div;
+
+ if (bios->sensor.slope_div) {
+ temp *= bios->sensor.slope_mult;
+ temp /= bios->sensor.slope_div;
+ }
+
+ temp += offset + correction;
+
+ return temp;
+}
+
+static int nouveau_thermal_nv50_read_temp(struct drm_device *dev)
+{
+ int temp = nv_rd32(dev, 0x20008) & 0x1fff;
+
+ temp = temp * 430 / 10000 - 227;
+ return temp;
+}
+
+static int nouveau_thermal_g84_read_temp(struct drm_device *dev)
+{
+ return nv_rd32(dev, 0x20400);
+}
+
+static int nouveau_thermal_i2c_xfer(struct i2c_adapter *adapter, int addr)
+{
+ int ret;
+ ret = i2c_smbus_xfer(adapter, addr, 0, 0, 0, I2C_SMBUS_QUICK, NULL);
+
+ if (ret)
+ return ret;
+
+ return 0;
+}
+
+static int nouveau_thermal_i2c_probe(struct i2c_adapter *adapter, int addr)
+{
+ struct i2c_board_info info = { };
+
+ if (nouveau_thermal_i2c_xfer(adapter, addr))
+ return -ENODEV;
+
+ switch (addr) {
+ case 0x2d:
+#ifndef CONFIG_SENSORS_W83781D
+ request_module("w83781d");
+#endif
+ strlcpy(info.type, "w83781d", sizeof(info.type));
+ info.addr = addr;
+ if (i2c_new_device(adapter, &info))
+ return 0;
+#ifndef CONFIG_SENSORS_W83L785TS
+ request_module("i2c:w83l785ts");
+#endif
+ strlcpy(info.type, "w83l785ts", sizeof(info.type));
+ info.addr = addr;
+ if (i2c_new_device(adapter, &info))
+ return 0;
+ break;
+ case 0x2e:
+#ifndef CONFIG_SENSORS_F75375S
+ request_module("i2c:f75375");
+#endif
+ strlcpy(info.type, "f75375", sizeof(info.type));
+ info.addr = addr;
+ if (i2c_new_device(adapter, &info))
+ return 0;
+#ifndef CONFIG_SENSORS_ADT7473
+ request_module("i2c:adt7473");
+#endif
+ strlcpy(info.type, "adt7473", sizeof(info.type));
+ info.addr = addr;
+ if (i2c_new_device(adapter, &info))
+ return 0;
+ break;
+ case 0x4c:
+#ifndef CONFIG_SENSORS_LM90
+ request_module("i2c:lm99");
+#endif
+ strlcpy(info.type, "lm99", sizeof(info.type));
+ info.addr = addr;
+ if (i2c_new_device(adapter, &info))
+ return 0;
+ break;
+ }
+ return -ENODEV;
+}
+
+
+int nouveau_thermal_i2c_create(struct drm_device *dev)
+{
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
+ struct nvbios *bios = &dev_priv->VBIOS;
+ struct i2c_adapter *adapter;
+ int address;
+
+ if (dev_priv->card_type < NV_50)
+ address = 2;
+ else
+ address = bios->bdcb.i2c_default_indices & 0xf;
+
+ if (nouveau_i2c_init(dev, &bios->bdcb.management_i2c, address))
+ return -ENODEV;
+
+ adapter = &bios->bdcb.management_i2c.chan->adapter;
+
+ nouveau_thermal_i2c_probe(adapter, 0x2d);
+ nouveau_thermal_i2c_probe(adapter, 0x2e);
+ nouveau_thermal_i2c_probe(adapter, 0x4c);
+ return 0;
+}
+
+static ssize_t nouveau_thermal_hwmon_show(struct device *dev,
+ struct device_attribute *devattr,
+ char *buf)
+{
+ struct drm_device *drm_dev = dev_get_drvdata(dev);
+ struct drm_nouveau_private *dev_priv = drm_dev->dev_private;
+
+ return sprintf(buf, "%u\n", dev_priv->get_gpu_temperature(drm_dev) *
+ 1000);
+}
+
+static ssize_t nouveau_thermal_hwmon_show_name(struct device *dev,
+ struct device_attribute *devattr,
+ char *buf)
+{
+ return sprintf(buf, "nouveau\n");
+}
+
+SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, nouveau_thermal_hwmon_show, NULL, 0);
+SENSOR_DEVICE_ATTR(name, S_IRUGO, nouveau_thermal_hwmon_show_name, NULL, 0);
+
+static struct attribute *hwmon_attributes[] = {
+ &sensor_dev_attr_temp1_input.dev_attr.attr,
+ &sensor_dev_attr_name.dev_attr.attr,
+ NULL,
+};
+
+static struct attribute_group hwmon_attribute_group = {
+ .attrs = hwmon_attributes
+};
+
+int nouveau_thermal_init(struct drm_device *dev)
+{
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
+ int err;
+
+ nouveau_thermal_i2c_create(dev);
+
+ if (dev_priv->chipset >= 0x84) {
+ dev_priv->get_gpu_temperature = nouveau_thermal_g84_read_temp;
+ } else if (nv_arch(dev) == NV_50) {
+ dev_priv->get_gpu_temperature = nouveau_thermal_nv50_read_temp;
+ } else if (nv_arch(dev) == NV_40) {
+ dev_priv->get_gpu_temperature = nouveau_thermal_nv40_read_temp;
+ if (nouveau_thermal_nv40_setup_sensor(dev))
+ dev_priv->get_gpu_temperature = NULL;
+ }
+
+ if (dev_priv->get_gpu_temperature) {
+ dev_priv->hwmon_dev = hwmon_device_register(&dev->pdev->dev);
+ dev_set_drvdata(dev_priv->hwmon_dev, dev);
+ err = sysfs_create_group(&dev_priv->hwmon_dev->kobj,
+ &hwmon_attribute_group);
+ if (err)
+ NV_ERROR(dev, "Unable to create hwmon sysfs file: %d\n",
+ err);
+ }
+
+ return 0;
+}
+
+void nouveau_thermal_exit(struct drm_device *dev)
+{
+ struct drm_nouveau_private *dev_priv = dev->dev_private;
+ struct nvbios *bios = &dev_priv->VBIOS;
+
+ if (dev_priv->hwmon_dev) {
+ sysfs_remove_group(&dev_priv->hwmon_dev->kobj,
+ &hwmon_attribute_group);
+ hwmon_device_unregister(dev_priv->hwmon_dev);
+ }
+ nouveau_i2c_fini(dev, &bios->bdcb.management_i2c);
+}
diff --git a/drivers/gpu/drm/nouveau/nouveau_thermal.h b/drivers/gpu/drm/nouveau/nouveau_thermal.h
new file mode 100644
index 0000000..f2cc3c8
--- /dev/null
+++ b/drivers/gpu/drm/nouveau/nouveau_thermal.h
@@ -0,0 +1,7 @@
+#ifndef __NOUVEAU_THERMAL_H
+#define __NOUVEAU_THERMAL_H
+
+int nouveau_thermal_init(struct drm_device *dev);
+void nouveau_thermal_exit(struct drm_device *dev);
+
+#endif
--
Matthew Garrett | mjg59 at srcf.ucam.org
More information about the Nouveau
mailing list