mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-30 23:50:07 +00:00 
			
		
		
		
	 b26e72fbb5
			
		
	
	
		b26e72fbb5
		
	
	
	
	
		
			
			There's a reported case where probing for f75375 causes the system to hang completely, in this case there's an adt7473 at the same i2c address. Signed-off-by: Ben Skeggs <bskeggs@redhat.com>
		
			
				
	
	
		
			310 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			310 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright 2010 PathScale inc.
 | |
|  *
 | |
|  * Permission is hereby granted, free of charge, to any person obtaining a
 | |
|  * copy of this software and associated documentation files (the "Software"),
 | |
|  * to deal in the Software without restriction, including without limitation
 | |
|  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 | |
|  * and/or sell copies of the Software, and to permit persons to whom the
 | |
|  * Software is furnished to do so, subject to the following conditions:
 | |
|  *
 | |
|  * The above copyright notice and this permission notice shall be included in
 | |
|  * all copies or substantial portions of the Software.
 | |
|  *
 | |
|  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | |
|  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | |
|  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 | |
|  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 | |
|  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 | |
|  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 | |
|  * OTHER DEALINGS IN THE SOFTWARE.
 | |
|  *
 | |
|  * Authors: Martin Peres
 | |
|  */
 | |
| 
 | |
| #include "drmP.h"
 | |
| 
 | |
| #include "nouveau_drv.h"
 | |
| #include "nouveau_pm.h"
 | |
| 
 | |
| static void
 | |
| nouveau_temp_vbios_parse(struct drm_device *dev, u8 *temp)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct nouveau_pm_engine *pm = &dev_priv->engine.pm;
 | |
| 	struct nouveau_pm_temp_sensor_constants *sensor = &pm->sensor_constants;
 | |
| 	struct nouveau_pm_threshold_temp *temps = &pm->threshold_temp;
 | |
| 	int i, headerlen, recordlen, entries;
 | |
| 
 | |
| 	if (!temp) {
 | |
| 		NV_DEBUG(dev, "temperature table pointer invalid\n");
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	/* Set the default sensor's contants */
 | |
| 	sensor->offset_constant = 0;
 | |
| 	sensor->offset_mult = 1;
 | |
| 	sensor->offset_div = 1;
 | |
| 	sensor->slope_mult = 1;
 | |
| 	sensor->slope_div = 1;
 | |
| 
 | |
| 	/* Set the default temperature thresholds */
 | |
| 	temps->critical = 110;
 | |
| 	temps->down_clock = 100;
 | |
| 	temps->fan_boost = 90;
 | |
| 
 | |
| 	/* Set the known default values to setup the temperature sensor */
 | |
| 	if (dev_priv->card_type >= NV_40) {
 | |
| 		switch (dev_priv->chipset) {
 | |
| 		case 0x43:
 | |
| 			sensor->offset_mult = 32060;
 | |
| 			sensor->offset_div = 1000;
 | |
| 			sensor->slope_mult = 792;
 | |
| 			sensor->slope_div = 1000;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x44:
 | |
| 		case 0x47:
 | |
| 		case 0x4a:
 | |
| 			sensor->offset_mult = 27839;
 | |
| 			sensor->offset_div = 1000;
 | |
| 			sensor->slope_mult = 780;
 | |
| 			sensor->slope_div = 1000;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x46:
 | |
| 			sensor->offset_mult = -24775;
 | |
| 			sensor->offset_div = 100;
 | |
| 			sensor->slope_mult = 467;
 | |
| 			sensor->slope_div = 10000;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x49:
 | |
| 			sensor->offset_mult = -25051;
 | |
| 			sensor->offset_div = 100;
 | |
| 			sensor->slope_mult = 458;
 | |
| 			sensor->slope_div = 10000;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x4b:
 | |
| 			sensor->offset_mult = -24088;
 | |
| 			sensor->offset_div = 100;
 | |
| 			sensor->slope_mult = 442;
 | |
| 			sensor->slope_div = 10000;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x50:
 | |
| 			sensor->offset_mult = -22749;
 | |
| 			sensor->offset_div = 100;
 | |
| 			sensor->slope_mult = 431;
 | |
| 			sensor->slope_div = 10000;
 | |
| 			break;
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	headerlen = temp[1];
 | |
| 	recordlen = temp[2];
 | |
| 	entries = temp[3];
 | |
| 	temp = temp + headerlen;
 | |
| 
 | |
| 	/* Read the entries from the table */
 | |
| 	for (i = 0; i < entries; i++) {
 | |
| 		u16 value = ROM16(temp[1]);
 | |
| 
 | |
| 		switch (temp[0]) {
 | |
| 		case 0x01:
 | |
| 			if ((value & 0x8f) == 0)
 | |
| 				sensor->offset_constant = (value >> 9) & 0x7f;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x04:
 | |
| 			if ((value & 0xf00f) == 0xa000) /* core */
 | |
| 				temps->critical = (value&0x0ff0) >> 4;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x07:
 | |
| 			if ((value & 0xf00f) == 0xa000) /* core */
 | |
| 				temps->down_clock = (value&0x0ff0) >> 4;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x08:
 | |
| 			if ((value & 0xf00f) == 0xa000) /* core */
 | |
| 				temps->fan_boost = (value&0x0ff0) >> 4;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x10:
 | |
| 			sensor->offset_mult = value;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x11:
 | |
| 			sensor->offset_div = value;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x12:
 | |
| 			sensor->slope_mult = value;
 | |
| 			break;
 | |
| 
 | |
| 		case 0x13:
 | |
| 			sensor->slope_div = value;
 | |
| 			break;
 | |
| 		}
 | |
| 		temp += recordlen;
 | |
| 	}
 | |
| 
 | |
| 	nouveau_temp_safety_checks(dev);
 | |
| }
 | |
| 
 | |
| static int
 | |
| nv40_sensor_setup(struct drm_device *dev)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct nouveau_pm_engine *pm = &dev_priv->engine.pm;
 | |
| 	struct nouveau_pm_temp_sensor_constants *sensor = &pm->sensor_constants;
 | |
| 	u32 offset = sensor->offset_mult / sensor->offset_div;
 | |
| 	u32 sensor_calibration;
 | |
| 
 | |
| 	/* set up the sensors */
 | |
| 	sensor_calibration = 120 - offset - sensor->offset_constant;
 | |
| 	sensor_calibration = sensor_calibration * sensor->slope_div /
 | |
| 				sensor->slope_mult;
 | |
| 
 | |
| 	if (dev_priv->chipset >= 0x46)
 | |
| 		sensor_calibration |= 0x80000000;
 | |
| 	else
 | |
| 		sensor_calibration |= 0x10000000;
 | |
| 
 | |
| 	nv_wr32(dev, 0x0015b0, sensor_calibration);
 | |
| 
 | |
| 	/* Wait for the sensor to update */
 | |
| 	msleep(5);
 | |
| 
 | |
| 	/* read */
 | |
| 	return nv_rd32(dev, 0x0015b4) & 0x1fff;
 | |
| }
 | |
| 
 | |
| int
 | |
| nv40_temp_get(struct drm_device *dev)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct nouveau_pm_engine *pm = &dev_priv->engine.pm;
 | |
| 	struct nouveau_pm_temp_sensor_constants *sensor = &pm->sensor_constants;
 | |
| 	int offset = sensor->offset_mult / sensor->offset_div;
 | |
| 	int core_temp;
 | |
| 
 | |
| 	if (dev_priv->card_type >= NV_50) {
 | |
| 		core_temp = nv_rd32(dev, 0x20008);
 | |
| 	} else {
 | |
| 		core_temp = nv_rd32(dev, 0x0015b4) & 0x1fff;
 | |
| 		/* Setup the sensor if the temperature is 0 */
 | |
| 		if (core_temp == 0)
 | |
| 			core_temp = nv40_sensor_setup(dev);
 | |
| 	}
 | |
| 
 | |
| 	core_temp = core_temp * sensor->slope_mult / sensor->slope_div;
 | |
| 	core_temp = core_temp + offset + sensor->offset_constant;
 | |
| 
 | |
| 	return core_temp;
 | |
| }
 | |
| 
 | |
| int
 | |
| nv84_temp_get(struct drm_device *dev)
 | |
| {
 | |
| 	return nv_rd32(dev, 0x20400);
 | |
| }
 | |
| 
 | |
| void
 | |
| nouveau_temp_safety_checks(struct drm_device *dev)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct nouveau_pm_engine *pm = &dev_priv->engine.pm;
 | |
| 	struct nouveau_pm_threshold_temp *temps = &pm->threshold_temp;
 | |
| 
 | |
| 	if (temps->critical > 120)
 | |
| 		temps->critical = 120;
 | |
| 	else if (temps->critical < 80)
 | |
| 		temps->critical = 80;
 | |
| 
 | |
| 	if (temps->down_clock > 110)
 | |
| 		temps->down_clock = 110;
 | |
| 	else if (temps->down_clock < 60)
 | |
| 		temps->down_clock = 60;
 | |
| 
 | |
| 	if (temps->fan_boost > 100)
 | |
| 		temps->fan_boost = 100;
 | |
| 	else if (temps->fan_boost < 40)
 | |
| 		temps->fan_boost = 40;
 | |
| }
 | |
| 
 | |
| static bool
 | |
| probe_monitoring_device(struct nouveau_i2c_chan *i2c,
 | |
| 			struct i2c_board_info *info)
 | |
| {
 | |
| 	char modalias[16] = "i2c:";
 | |
| 	struct i2c_client *client;
 | |
| 
 | |
| 	strlcat(modalias, info->type, sizeof(modalias));
 | |
| 	request_module(modalias);
 | |
| 
 | |
| 	client = i2c_new_device(&i2c->adapter, info);
 | |
| 	if (!client)
 | |
| 		return false;
 | |
| 
 | |
| 	if (!client->driver || client->driver->detect(client, info)) {
 | |
| 		i2c_unregister_device(client);
 | |
| 		return false;
 | |
| 	}
 | |
| 
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| static void
 | |
| nouveau_temp_probe_i2c(struct drm_device *dev)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct dcb_table *dcb = &dev_priv->vbios.dcb;
 | |
| 	struct i2c_board_info info[] = {
 | |
| 		{ I2C_BOARD_INFO("w83l785ts", 0x2d) },
 | |
| 		{ I2C_BOARD_INFO("w83781d", 0x2d) },
 | |
| 		{ I2C_BOARD_INFO("adt7473", 0x2e) },
 | |
| 		{ I2C_BOARD_INFO("f75375", 0x2e) },
 | |
| 		{ I2C_BOARD_INFO("lm99", 0x4c) },
 | |
| 		{ }
 | |
| 	};
 | |
| 	int idx = (dcb->version >= 0x40 ?
 | |
| 		   dcb->i2c_default_indices & 0xf : 2);
 | |
| 
 | |
| 	nouveau_i2c_identify(dev, "monitoring device", info,
 | |
| 			     probe_monitoring_device, idx);
 | |
| }
 | |
| 
 | |
| void
 | |
| nouveau_temp_init(struct drm_device *dev)
 | |
| {
 | |
| 	struct drm_nouveau_private *dev_priv = dev->dev_private;
 | |
| 	struct nvbios *bios = &dev_priv->vbios;
 | |
| 	struct bit_entry P;
 | |
| 	u8 *temp = NULL;
 | |
| 
 | |
| 	if (bios->type == NVBIOS_BIT) {
 | |
| 		if (bit_table(dev, 'P', &P))
 | |
| 			return;
 | |
| 
 | |
| 		if (P.version == 1)
 | |
| 			temp = ROMPTR(bios, P.data[12]);
 | |
| 		else if (P.version == 2)
 | |
| 			temp = ROMPTR(bios, P.data[16]);
 | |
| 		else
 | |
| 			NV_WARN(dev, "unknown temp for BIT P %d\n", P.version);
 | |
| 
 | |
| 		nouveau_temp_vbios_parse(dev, temp);
 | |
| 	}
 | |
| 
 | |
| 	nouveau_temp_probe_i2c(dev);
 | |
| }
 | |
| 
 | |
| void
 | |
| nouveau_temp_fini(struct drm_device *dev)
 | |
| {
 | |
| 
 | |
| }
 |