| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | Copyright (c) 1999-2002 Merlin Hughes <merlin@merlin.org> | 
|  | 3 |  | 
|  | 4 | Shamelessly ripped from i2c-piix4.c: | 
|  | 5 |  | 
|  | 6 | Copyright (c) 1998, 1999  Frodo Looijaard <frodol@dds.nl> and | 
|  | 7 | Philip Edelbrock <phil@netroedge.com> | 
|  | 8 |  | 
|  | 9 | This program is free software; you can redistribute it and/or modify | 
|  | 10 | it under the terms of the GNU General Public License as published by | 
|  | 11 | the Free Software Foundation; either version 2 of the License, or | 
|  | 12 | (at your option) any later version. | 
|  | 13 |  | 
|  | 14 | This program is distributed in the hope that it will be useful, | 
|  | 15 | but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | 17 | GNU General Public License for more details. | 
|  | 18 |  | 
|  | 19 | You should have received a copy of the GNU General Public License | 
|  | 20 | along with this program; if not, write to the Free Software | 
|  | 21 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | 
|  | 22 | */ | 
|  | 23 |  | 
|  | 24 | /* | 
|  | 25 | 2002-04-08: Added nForce support. (Csaba Halasz) | 
|  | 26 | 2002-10-03: Fixed nForce PnP I/O port. (Michael Steil) | 
|  | 27 | 2002-12-28: Rewritten into something that resembles a Linux driver (hch) | 
|  | 28 | 2003-11-29: Added back AMD8111 removed by the previous rewrite. | 
|  | 29 | (Philip Pokorny) | 
|  | 30 | */ | 
|  | 31 |  | 
|  | 32 | /* | 
|  | 33 | Supports AMD756, AMD766, AMD768, AMD8111 and nVidia nForce | 
|  | 34 | Note: we assume there can only be one device, with one SMBus interface. | 
|  | 35 | */ | 
|  | 36 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | #include <linux/module.h> | 
|  | 38 | #include <linux/pci.h> | 
|  | 39 | #include <linux/kernel.h> | 
|  | 40 | #include <linux/delay.h> | 
|  | 41 | #include <linux/stddef.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | #include <linux/ioport.h> | 
|  | 43 | #include <linux/i2c.h> | 
|  | 44 | #include <linux/init.h> | 
| Jean Delvare | 54fb4a05 | 2008-07-14 22:38:33 +0200 | [diff] [blame] | 45 | #include <linux/acpi.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | #include <asm/io.h> | 
|  | 47 |  | 
|  | 48 | /* AMD756 SMBus address offsets */ | 
|  | 49 | #define SMB_ADDR_OFFSET		0xE0 | 
|  | 50 | #define SMB_IOSIZE		16 | 
|  | 51 | #define SMB_GLOBAL_STATUS	(0x0 + amd756_ioport) | 
|  | 52 | #define SMB_GLOBAL_ENABLE	(0x2 + amd756_ioport) | 
|  | 53 | #define SMB_HOST_ADDRESS	(0x4 + amd756_ioport) | 
|  | 54 | #define SMB_HOST_DATA		(0x6 + amd756_ioport) | 
|  | 55 | #define SMB_HOST_COMMAND	(0x8 + amd756_ioport) | 
|  | 56 | #define SMB_HOST_BLOCK_DATA	(0x9 + amd756_ioport) | 
|  | 57 | #define SMB_HAS_DATA		(0xA + amd756_ioport) | 
|  | 58 | #define SMB_HAS_DEVICE_ADDRESS	(0xC + amd756_ioport) | 
|  | 59 | #define SMB_HAS_HOST_ADDRESS	(0xE + amd756_ioport) | 
|  | 60 | #define SMB_SNOOP_ADDRESS	(0xF + amd756_ioport) | 
|  | 61 |  | 
|  | 62 | /* PCI Address Constants */ | 
|  | 63 |  | 
|  | 64 | /* address of I/O space */ | 
|  | 65 | #define SMBBA		0x058		/* mh */ | 
|  | 66 | #define SMBBANFORCE	0x014 | 
|  | 67 |  | 
|  | 68 | /* general configuration */ | 
|  | 69 | #define SMBGCFG		0x041		/* mh */ | 
|  | 70 |  | 
|  | 71 | /* silicon revision code */ | 
|  | 72 | #define SMBREV		0x008 | 
|  | 73 |  | 
|  | 74 | /* Other settings */ | 
|  | 75 | #define MAX_TIMEOUT	500 | 
|  | 76 |  | 
|  | 77 | /* AMD756 constants */ | 
|  | 78 | #define AMD756_QUICK		0x00 | 
|  | 79 | #define AMD756_BYTE		0x01 | 
|  | 80 | #define AMD756_BYTE_DATA	0x02 | 
|  | 81 | #define AMD756_WORD_DATA	0x03 | 
|  | 82 | #define AMD756_PROCESS_CALL	0x04 | 
|  | 83 | #define AMD756_BLOCK_DATA	0x05 | 
|  | 84 |  | 
| Jean Delvare | d6072f8 | 2005-09-25 16:37:04 +0200 | [diff] [blame] | 85 | static struct pci_driver amd756_driver; | 
| Jean Delvare | 6050709 | 2005-09-25 16:23:07 +0200 | [diff] [blame] | 86 | static unsigned short amd756_ioport; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 |  | 
|  | 88 | /* | 
|  | 89 | SMBUS event = I/O 28-29 bit 11 | 
|  | 90 | see E0 for the status bits and enabled in E2 | 
|  | 91 |  | 
|  | 92 | */ | 
|  | 93 | #define GS_ABRT_STS	(1 << 0) | 
|  | 94 | #define GS_COL_STS	(1 << 1) | 
|  | 95 | #define GS_PRERR_STS	(1 << 2) | 
|  | 96 | #define GS_HST_STS	(1 << 3) | 
|  | 97 | #define GS_HCYC_STS	(1 << 4) | 
|  | 98 | #define GS_TO_STS	(1 << 5) | 
|  | 99 | #define GS_SMB_STS	(1 << 11) | 
|  | 100 |  | 
|  | 101 | #define GS_CLEAR_STS	(GS_ABRT_STS | GS_COL_STS | GS_PRERR_STS | \ | 
|  | 102 | GS_HCYC_STS | GS_TO_STS ) | 
|  | 103 |  | 
|  | 104 | #define GE_CYC_TYPE_MASK	(7) | 
|  | 105 | #define GE_HOST_STC		(1 << 3) | 
|  | 106 | #define GE_ABORT		(1 << 5) | 
|  | 107 |  | 
|  | 108 |  | 
|  | 109 | static int amd756_transaction(struct i2c_adapter *adap) | 
|  | 110 | { | 
|  | 111 | int temp; | 
|  | 112 | int result = 0; | 
|  | 113 | int timeout = 0; | 
|  | 114 |  | 
|  | 115 | dev_dbg(&adap->dev, "Transaction (pre): GS=%04x, GE=%04x, ADD=%04x, " | 
|  | 116 | "DAT=%04x\n", inw_p(SMB_GLOBAL_STATUS), | 
|  | 117 | inw_p(SMB_GLOBAL_ENABLE), inw_p(SMB_HOST_ADDRESS), | 
|  | 118 | inb_p(SMB_HOST_DATA)); | 
|  | 119 |  | 
|  | 120 | /* Make sure the SMBus host is ready to start transmitting */ | 
|  | 121 | if ((temp = inw_p(SMB_GLOBAL_STATUS)) & (GS_HST_STS | GS_SMB_STS)) { | 
|  | 122 | dev_dbg(&adap->dev, "SMBus busy (%04x). Waiting...\n", temp); | 
|  | 123 | do { | 
|  | 124 | msleep(1); | 
|  | 125 | temp = inw_p(SMB_GLOBAL_STATUS); | 
|  | 126 | } while ((temp & (GS_HST_STS | GS_SMB_STS)) && | 
|  | 127 | (timeout++ < MAX_TIMEOUT)); | 
|  | 128 | /* If the SMBus is still busy, we give up */ | 
| Roel Kluin | 4ccc28f | 2009-05-05 08:39:24 +0200 | [diff] [blame] | 129 | if (timeout > MAX_TIMEOUT) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | dev_dbg(&adap->dev, "Busy wait timeout (%04x)\n", temp); | 
|  | 131 | goto abort; | 
|  | 132 | } | 
|  | 133 | timeout = 0; | 
|  | 134 | } | 
|  | 135 |  | 
|  | 136 | /* start the transaction by setting the start bit */ | 
|  | 137 | outw_p(inw(SMB_GLOBAL_ENABLE) | GE_HOST_STC, SMB_GLOBAL_ENABLE); | 
|  | 138 |  | 
|  | 139 | /* We will always wait for a fraction of a second! */ | 
|  | 140 | do { | 
|  | 141 | msleep(1); | 
|  | 142 | temp = inw_p(SMB_GLOBAL_STATUS); | 
|  | 143 | } while ((temp & GS_HST_STS) && (timeout++ < MAX_TIMEOUT)); | 
|  | 144 |  | 
|  | 145 | /* If the SMBus is still busy, we give up */ | 
| Roel Kluin | 4ccc28f | 2009-05-05 08:39:24 +0200 | [diff] [blame] | 146 | if (timeout > MAX_TIMEOUT) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 147 | dev_dbg(&adap->dev, "Completion timeout!\n"); | 
|  | 148 | goto abort; | 
|  | 149 | } | 
|  | 150 |  | 
|  | 151 | if (temp & GS_PRERR_STS) { | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 152 | result = -ENXIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | dev_dbg(&adap->dev, "SMBus Protocol error (no response)!\n"); | 
|  | 154 | } | 
|  | 155 |  | 
|  | 156 | if (temp & GS_COL_STS) { | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 157 | result = -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 158 | dev_warn(&adap->dev, "SMBus collision!\n"); | 
|  | 159 | } | 
|  | 160 |  | 
|  | 161 | if (temp & GS_TO_STS) { | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 162 | result = -ETIMEDOUT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 163 | dev_dbg(&adap->dev, "SMBus protocol timeout!\n"); | 
|  | 164 | } | 
|  | 165 |  | 
|  | 166 | if (temp & GS_HCYC_STS) | 
|  | 167 | dev_dbg(&adap->dev, "SMBus protocol success!\n"); | 
|  | 168 |  | 
|  | 169 | outw_p(GS_CLEAR_STS, SMB_GLOBAL_STATUS); | 
|  | 170 |  | 
|  | 171 | #ifdef DEBUG | 
|  | 172 | if (((temp = inw_p(SMB_GLOBAL_STATUS)) & GS_CLEAR_STS) != 0x00) { | 
|  | 173 | dev_dbg(&adap->dev, | 
|  | 174 | "Failed reset at end of transaction (%04x)\n", temp); | 
|  | 175 | } | 
|  | 176 | #endif | 
|  | 177 |  | 
|  | 178 | dev_dbg(&adap->dev, | 
|  | 179 | "Transaction (post): GS=%04x, GE=%04x, ADD=%04x, DAT=%04x\n", | 
|  | 180 | inw_p(SMB_GLOBAL_STATUS), inw_p(SMB_GLOBAL_ENABLE), | 
|  | 181 | inw_p(SMB_HOST_ADDRESS), inb_p(SMB_HOST_DATA)); | 
|  | 182 |  | 
|  | 183 | return result; | 
|  | 184 |  | 
|  | 185 | abort: | 
|  | 186 | dev_warn(&adap->dev, "Sending abort\n"); | 
|  | 187 | outw_p(inw(SMB_GLOBAL_ENABLE) | GE_ABORT, SMB_GLOBAL_ENABLE); | 
|  | 188 | msleep(100); | 
|  | 189 | outw_p(GS_CLEAR_STS, SMB_GLOBAL_STATUS); | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 190 | return -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 191 | } | 
|  | 192 |  | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 193 | /* Return negative errno on error. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | static s32 amd756_access(struct i2c_adapter * adap, u16 addr, | 
|  | 195 | unsigned short flags, char read_write, | 
|  | 196 | u8 command, int size, union i2c_smbus_data * data) | 
|  | 197 | { | 
|  | 198 | int i, len; | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 199 | int status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 201 | switch (size) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 | case I2C_SMBUS_QUICK: | 
|  | 203 | outw_p(((addr & 0x7f) << 1) | (read_write & 0x01), | 
|  | 204 | SMB_HOST_ADDRESS); | 
|  | 205 | size = AMD756_QUICK; | 
|  | 206 | break; | 
|  | 207 | case I2C_SMBUS_BYTE: | 
|  | 208 | outw_p(((addr & 0x7f) << 1) | (read_write & 0x01), | 
|  | 209 | SMB_HOST_ADDRESS); | 
|  | 210 | if (read_write == I2C_SMBUS_WRITE) | 
|  | 211 | outb_p(command, SMB_HOST_DATA); | 
|  | 212 | size = AMD756_BYTE; | 
|  | 213 | break; | 
|  | 214 | case I2C_SMBUS_BYTE_DATA: | 
|  | 215 | outw_p(((addr & 0x7f) << 1) | (read_write & 0x01), | 
|  | 216 | SMB_HOST_ADDRESS); | 
|  | 217 | outb_p(command, SMB_HOST_COMMAND); | 
|  | 218 | if (read_write == I2C_SMBUS_WRITE) | 
|  | 219 | outw_p(data->byte, SMB_HOST_DATA); | 
|  | 220 | size = AMD756_BYTE_DATA; | 
|  | 221 | break; | 
|  | 222 | case I2C_SMBUS_WORD_DATA: | 
|  | 223 | outw_p(((addr & 0x7f) << 1) | (read_write & 0x01), | 
|  | 224 | SMB_HOST_ADDRESS); | 
|  | 225 | outb_p(command, SMB_HOST_COMMAND); | 
|  | 226 | if (read_write == I2C_SMBUS_WRITE) | 
|  | 227 | outw_p(data->word, SMB_HOST_DATA);	/* TODO: endian???? */ | 
|  | 228 | size = AMD756_WORD_DATA; | 
|  | 229 | break; | 
|  | 230 | case I2C_SMBUS_BLOCK_DATA: | 
|  | 231 | outw_p(((addr & 0x7f) << 1) | (read_write & 0x01), | 
|  | 232 | SMB_HOST_ADDRESS); | 
|  | 233 | outb_p(command, SMB_HOST_COMMAND); | 
|  | 234 | if (read_write == I2C_SMBUS_WRITE) { | 
|  | 235 | len = data->block[0]; | 
|  | 236 | if (len < 0) | 
|  | 237 | len = 0; | 
|  | 238 | if (len > 32) | 
|  | 239 | len = 32; | 
|  | 240 | outw_p(len, SMB_HOST_DATA); | 
|  | 241 | /* i = inw_p(SMBHSTCNT); Reset SMBBLKDAT */ | 
|  | 242 | for (i = 1; i <= len; i++) | 
|  | 243 | outb_p(data->block[i], | 
|  | 244 | SMB_HOST_BLOCK_DATA); | 
|  | 245 | } | 
|  | 246 | size = AMD756_BLOCK_DATA; | 
|  | 247 | break; | 
| Jean Delvare | ac7fc4f | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 248 | default: | 
|  | 249 | dev_warn(&adap->dev, "Unsupported transaction %d\n", size); | 
|  | 250 | return -EOPNOTSUPP; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | } | 
|  | 252 |  | 
|  | 253 | /* How about enabling interrupts... */ | 
|  | 254 | outw_p(size & GE_CYC_TYPE_MASK, SMB_GLOBAL_ENABLE); | 
|  | 255 |  | 
| David Brownell | 9714034 | 2008-07-14 22:38:25 +0200 | [diff] [blame] | 256 | status = amd756_transaction(adap); | 
|  | 257 | if (status) | 
|  | 258 | return status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 |  | 
|  | 260 | if ((read_write == I2C_SMBUS_WRITE) || (size == AMD756_QUICK)) | 
|  | 261 | return 0; | 
|  | 262 |  | 
|  | 263 |  | 
|  | 264 | switch (size) { | 
|  | 265 | case AMD756_BYTE: | 
|  | 266 | data->byte = inw_p(SMB_HOST_DATA); | 
|  | 267 | break; | 
|  | 268 | case AMD756_BYTE_DATA: | 
|  | 269 | data->byte = inw_p(SMB_HOST_DATA); | 
|  | 270 | break; | 
|  | 271 | case AMD756_WORD_DATA: | 
|  | 272 | data->word = inw_p(SMB_HOST_DATA);	/* TODO: endian???? */ | 
|  | 273 | break; | 
|  | 274 | case AMD756_BLOCK_DATA: | 
|  | 275 | data->block[0] = inw_p(SMB_HOST_DATA) & 0x3f; | 
|  | 276 | if(data->block[0] > 32) | 
|  | 277 | data->block[0] = 32; | 
|  | 278 | /* i = inw_p(SMBHSTCNT); Reset SMBBLKDAT */ | 
|  | 279 | for (i = 1; i <= data->block[0]; i++) | 
|  | 280 | data->block[i] = inb_p(SMB_HOST_BLOCK_DATA); | 
|  | 281 | break; | 
|  | 282 | } | 
|  | 283 |  | 
|  | 284 | return 0; | 
|  | 285 | } | 
|  | 286 |  | 
|  | 287 | static u32 amd756_func(struct i2c_adapter *adapter) | 
|  | 288 | { | 
|  | 289 | return I2C_FUNC_SMBUS_QUICK | I2C_FUNC_SMBUS_BYTE | | 
|  | 290 | I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA | | 
| Jean Delvare | 875b0a4 | 2008-05-18 20:49:41 +0200 | [diff] [blame] | 291 | I2C_FUNC_SMBUS_BLOCK_DATA; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 292 | } | 
|  | 293 |  | 
| Jean Delvare | 8f9082c | 2006-09-03 22:39:46 +0200 | [diff] [blame] | 294 | static const struct i2c_algorithm smbus_algorithm = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 295 | .smbus_xfer	= amd756_access, | 
|  | 296 | .functionality	= amd756_func, | 
|  | 297 | }; | 
|  | 298 |  | 
|  | 299 | struct i2c_adapter amd756_smbus = { | 
|  | 300 | .owner		= THIS_MODULE, | 
| Jean Delvare | 3401b2f | 2008-07-14 22:38:29 +0200 | [diff] [blame] | 301 | .class          = I2C_CLASS_HWMON | I2C_CLASS_SPD, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 302 | .algo		= &smbus_algorithm, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 303 | }; | 
|  | 304 |  | 
|  | 305 | enum chiptype { AMD756, AMD766, AMD768, NFORCE, AMD8111 }; | 
|  | 306 | static const char* chipname[] = { | 
|  | 307 | "AMD756", "AMD766", "AMD768", | 
|  | 308 | "nVidia nForce", "AMD8111", | 
|  | 309 | }; | 
|  | 310 |  | 
|  | 311 | static struct pci_device_id amd756_ids[] = { | 
|  | 312 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_VIPER_740B), | 
|  | 313 | .driver_data = AMD756 }, | 
|  | 314 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_VIPER_7413), | 
|  | 315 | .driver_data = AMD766 }, | 
|  | 316 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_OPUS_7443), | 
|  | 317 | .driver_data = AMD768 }, | 
|  | 318 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_8111_SMBUS), | 
|  | 319 | .driver_data = AMD8111 }, | 
|  | 320 | { PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NFORCE_SMBUS), | 
|  | 321 | .driver_data = NFORCE }, | 
|  | 322 | { 0, } | 
|  | 323 | }; | 
|  | 324 |  | 
|  | 325 | MODULE_DEVICE_TABLE (pci, amd756_ids); | 
|  | 326 |  | 
|  | 327 | static int __devinit amd756_probe(struct pci_dev *pdev, | 
|  | 328 | const struct pci_device_id *id) | 
|  | 329 | { | 
|  | 330 | int nforce = (id->driver_data == NFORCE); | 
|  | 331 | int error; | 
|  | 332 | u8 temp; | 
|  | 333 |  | 
|  | 334 | if (amd756_ioport) { | 
|  | 335 | dev_err(&pdev->dev, "Only one device supported " | 
|  | 336 | "(you have a strange motherboard, btw)\n"); | 
|  | 337 | return -ENODEV; | 
|  | 338 | } | 
|  | 339 |  | 
|  | 340 | if (nforce) { | 
|  | 341 | if (PCI_FUNC(pdev->devfn) != 1) | 
|  | 342 | return -ENODEV; | 
|  | 343 |  | 
|  | 344 | pci_read_config_word(pdev, SMBBANFORCE, &amd756_ioport); | 
|  | 345 | amd756_ioport &= 0xfffc; | 
|  | 346 | } else { /* amd */ | 
|  | 347 | if (PCI_FUNC(pdev->devfn) != 3) | 
|  | 348 | return -ENODEV; | 
|  | 349 |  | 
|  | 350 | pci_read_config_byte(pdev, SMBGCFG, &temp); | 
|  | 351 | if ((temp & 128) == 0) { | 
|  | 352 | dev_err(&pdev->dev, | 
|  | 353 | "Error: SMBus controller I/O not enabled!\n"); | 
|  | 354 | return -ENODEV; | 
|  | 355 | } | 
|  | 356 |  | 
|  | 357 | /* Determine the address of the SMBus areas */ | 
|  | 358 | /* Technically it is a dword but... */ | 
|  | 359 | pci_read_config_word(pdev, SMBBA, &amd756_ioport); | 
|  | 360 | amd756_ioport &= 0xff00; | 
|  | 361 | amd756_ioport += SMB_ADDR_OFFSET; | 
|  | 362 | } | 
|  | 363 |  | 
| Jean Delvare | 54fb4a05 | 2008-07-14 22:38:33 +0200 | [diff] [blame] | 364 | error = acpi_check_region(amd756_ioport, SMB_IOSIZE, | 
|  | 365 | amd756_driver.name); | 
|  | 366 | if (error) | 
|  | 367 | return error; | 
|  | 368 |  | 
| Jean Delvare | d6072f8 | 2005-09-25 16:37:04 +0200 | [diff] [blame] | 369 | if (!request_region(amd756_ioport, SMB_IOSIZE, amd756_driver.name)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 370 | dev_err(&pdev->dev, "SMB region 0x%x already in use!\n", | 
|  | 371 | amd756_ioport); | 
|  | 372 | return -ENODEV; | 
|  | 373 | } | 
|  | 374 |  | 
|  | 375 | pci_read_config_byte(pdev, SMBREV, &temp); | 
|  | 376 | dev_dbg(&pdev->dev, "SMBREV = 0x%X\n", temp); | 
|  | 377 | dev_dbg(&pdev->dev, "AMD756_smba = 0x%X\n", amd756_ioport); | 
|  | 378 |  | 
| Robert P. J. Day | 405ae7d | 2007-02-17 19:13:42 +0100 | [diff] [blame] | 379 | /* set up the sysfs linkage to our parent device */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 380 | amd756_smbus.dev.parent = &pdev->dev; | 
|  | 381 |  | 
| Jean Delvare | 66c7acf | 2009-01-07 14:29:18 +0100 | [diff] [blame] | 382 | snprintf(amd756_smbus.name, sizeof(amd756_smbus.name), | 
|  | 383 | "SMBus %s adapter at %04x", chipname[id->driver_data], | 
|  | 384 | amd756_ioport); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 385 |  | 
|  | 386 | error = i2c_add_adapter(&amd756_smbus); | 
|  | 387 | if (error) { | 
|  | 388 | dev_err(&pdev->dev, | 
|  | 389 | "Adapter registration failed, module not inserted\n"); | 
|  | 390 | goto out_err; | 
|  | 391 | } | 
|  | 392 |  | 
|  | 393 | return 0; | 
|  | 394 |  | 
|  | 395 | out_err: | 
|  | 396 | release_region(amd756_ioport, SMB_IOSIZE); | 
|  | 397 | return error; | 
|  | 398 | } | 
|  | 399 |  | 
|  | 400 | static void __devexit amd756_remove(struct pci_dev *dev) | 
|  | 401 | { | 
|  | 402 | i2c_del_adapter(&amd756_smbus); | 
|  | 403 | release_region(amd756_ioport, SMB_IOSIZE); | 
|  | 404 | } | 
|  | 405 |  | 
|  | 406 | static struct pci_driver amd756_driver = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 407 | .name		= "amd756_smbus", | 
|  | 408 | .id_table	= amd756_ids, | 
|  | 409 | .probe		= amd756_probe, | 
|  | 410 | .remove		= __devexit_p(amd756_remove), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 411 | }; | 
|  | 412 |  | 
|  | 413 | static int __init amd756_init(void) | 
|  | 414 | { | 
|  | 415 | return pci_register_driver(&amd756_driver); | 
|  | 416 | } | 
|  | 417 |  | 
|  | 418 | static void __exit amd756_exit(void) | 
|  | 419 | { | 
|  | 420 | pci_unregister_driver(&amd756_driver); | 
|  | 421 | } | 
|  | 422 |  | 
|  | 423 | MODULE_AUTHOR("Merlin Hughes <merlin@merlin.org>"); | 
|  | 424 | MODULE_DESCRIPTION("AMD756/766/768/8111 and nVidia nForce SMBus driver"); | 
|  | 425 | MODULE_LICENSE("GPL"); | 
|  | 426 |  | 
|  | 427 | EXPORT_SYMBOL(amd756_smbus); | 
|  | 428 |  | 
|  | 429 | module_init(amd756_init) | 
|  | 430 | module_exit(amd756_exit) |