mirror of
https://github.com/lm-sensors/lm-sensors.git
synced 2026-10-22 11:46:03 +00:00
Mark D. Studebaker
248547cefb
Also check return code on ioremap_nocache(). git-svn-id: http://lm-sensors.org/svn/lm-sensors/trunk@1427 7894878c-1315-0410-8ee3-d5d059ff63e0
380 lines
8.3 KiB
C
380 lines
8.3 KiB
C
/*
|
|
i2c-savage4.c - Part of lm_sensors, Linux kernel modules for hardware
|
|
monitoring
|
|
Copyright (c) 1998, 1999 Frodo Looijaard <frodol@dds.nl>,
|
|
Philip Edelbrock <phil@netroedge.com>,
|
|
Ralph Metzler <rjkm@thp.uni-koeln.de>, and
|
|
Mark D. Studebaker <mdsxyz123@yahoo.com>
|
|
|
|
Based on code written by Ralph Metzler <rjkm@thp.uni-koeln.de> and
|
|
Simon Vogl
|
|
|
|
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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
/* This interfaces to the I2C bus of the Savage4 to gain access to
|
|
the BT869 and possibly other I2C devices. The DDC bus is not
|
|
yet supported because its register is not memory-mapped.
|
|
However we leave the DDC code here, commented out, to make
|
|
it easier to add later.
|
|
*/
|
|
|
|
#include <linux/version.h>
|
|
#include <linux/module.h>
|
|
#include <linux/pci.h>
|
|
#include <asm/io.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c-algo-bit.h>
|
|
#include "version.h"
|
|
#include <linux/init.h>
|
|
|
|
#ifndef I2C_HW_B_SAVG
|
|
#define I2C_HW_B_SAVG 0x0d
|
|
#endif
|
|
|
|
/* 3DFX defines */
|
|
/* #define PCI_VENDOR_ID_S3 0x5333 */
|
|
#define PCI_CHIP_SAVAGE3D 0x8A20
|
|
#define PCI_CHIP_SAVAGE3D_MV 0x8A21
|
|
#define PCI_CHIP_SAVAGE4 0x8A22
|
|
#define PCI_CHIP_SAVAGE2000 0x9102
|
|
#define PCI_CHIP_PROSAVAGE_PM 0x8A25
|
|
#define PCI_CHIP_PROSAVAGE_KM 0x8A26
|
|
#define PCI_CHIP_SAVAGE_MX_MV 0x8c10
|
|
#define PCI_CHIP_SAVAGE_MX 0x8c11
|
|
#define PCI_CHIP_SAVAGE_IX_MV 0x8c12
|
|
#define PCI_CHIP_SAVAGE_IX 0x8c13
|
|
|
|
#define REG 0xff20 /* Serial Port 1 Register */
|
|
|
|
/* bit locations in the register */
|
|
//#define DDC_ENAB 0x00040000
|
|
//#define DDC_SCL_OUT 0x00080000
|
|
//#define DDC_SDA_OUT 0x00100000
|
|
//#define DDC_SCL_IN 0x00200000
|
|
//#define DDC_SDA_IN 0x00400000
|
|
#define I2C_ENAB 0x00000020
|
|
#define I2C_SCL_OUT 0x00000001
|
|
#define I2C_SDA_OUT 0x00000002
|
|
#define I2C_SCL_IN 0x00000008
|
|
#define I2C_SDA_IN 0x00000010
|
|
|
|
/* initialization states */
|
|
#define INIT2 0x20
|
|
/* #define INIT3 0x4 */
|
|
|
|
/* delays */
|
|
#define CYCLE_DELAY 10
|
|
#define TIMEOUT 50
|
|
|
|
#ifdef MODULE
|
|
static
|
|
#else
|
|
extern
|
|
#endif
|
|
int __init i2c_savage4_init(void);
|
|
static int __init savage4_cleanup(void);
|
|
static int savage4_setup(void);
|
|
static void config_s4(struct pci_dev *dev);
|
|
static void savage4_inc(struct i2c_adapter *adapter);
|
|
static void savage4_dec(struct i2c_adapter *adapter);
|
|
|
|
#ifdef MODULE
|
|
extern int init_module(void);
|
|
extern int cleanup_module(void);
|
|
#endif /* MODULE */
|
|
|
|
|
|
static int __initdata savage4_initialized;
|
|
static unsigned char *mem;
|
|
|
|
extern inline void outlong(unsigned int dat)
|
|
{
|
|
*((unsigned int *) (mem + REG)) = dat;
|
|
}
|
|
|
|
extern inline unsigned int readlong(void)
|
|
{
|
|
return *((unsigned int *) (mem + REG));
|
|
}
|
|
|
|
/* The sav GPIO registers don't have individual masks for each bit
|
|
so we always have to read before writing. */
|
|
|
|
static void bit_savi2c_setscl(void *data, int val)
|
|
{
|
|
unsigned int r;
|
|
r = readlong();
|
|
if(val)
|
|
r |= I2C_SCL_OUT;
|
|
else
|
|
r &= ~I2C_SCL_OUT;
|
|
outlong(r);
|
|
readlong(); /* flush posted write */
|
|
}
|
|
|
|
static void bit_savi2c_setsda(void *data, int val)
|
|
{
|
|
unsigned int r;
|
|
r = readlong();
|
|
if(val)
|
|
r |= I2C_SDA_OUT;
|
|
else
|
|
r &= ~I2C_SDA_OUT;
|
|
outlong(r);
|
|
readlong(); /* flush posted write */
|
|
}
|
|
|
|
/* The GPIO pins are open drain, so the pins always remain outputs.
|
|
We rely on the i2c-algo-bit routines to set the pins high before
|
|
reading the input from other chips. */
|
|
|
|
static int bit_savi2c_getscl(void *data)
|
|
{
|
|
return (0 != (readlong() & I2C_SCL_IN));
|
|
}
|
|
|
|
static int bit_savi2c_getsda(void *data)
|
|
{
|
|
return (0 != (readlong() & I2C_SDA_IN));
|
|
}
|
|
|
|
/*static void bit_savddc_setscl(void *data, int val)
|
|
{
|
|
unsigned int r;
|
|
r = readlong();
|
|
if(val)
|
|
r |= DDC_SCL_OUT;
|
|
else
|
|
r &= ~DDC_SCL_OUT;
|
|
outlong(r);
|
|
}
|
|
|
|
static void bit_savddc_setsda(void *data, int val)
|
|
{
|
|
unsigned int r;
|
|
r = readlong();
|
|
if(val)
|
|
r |= DDC_SDA_OUT;
|
|
else
|
|
r &= ~DDC_SDA_OUT;
|
|
outlong(r);
|
|
}
|
|
|
|
static int bit_savddc_getscl(void *data)
|
|
{
|
|
return (0 != (readlong() & DDC_SCL_IN));
|
|
}
|
|
|
|
static int bit_savddc_getsda(void *data)
|
|
{
|
|
return (0 != (readlong() & DDC_SDA_IN));
|
|
}
|
|
*/
|
|
static struct i2c_algo_bit_data sav_i2c_bit_data = {
|
|
NULL,
|
|
bit_savi2c_setsda,
|
|
bit_savi2c_setscl,
|
|
bit_savi2c_getsda,
|
|
bit_savi2c_getscl,
|
|
CYCLE_DELAY, CYCLE_DELAY, TIMEOUT
|
|
};
|
|
|
|
static struct i2c_adapter savage4_i2c_adapter = {
|
|
"I2C Savage4 adapter",
|
|
I2C_HW_B_SAVG,
|
|
NULL,
|
|
&sav_i2c_bit_data,
|
|
savage4_inc,
|
|
savage4_dec,
|
|
NULL,
|
|
NULL,
|
|
};
|
|
/*
|
|
static struct i2c_algo_bit_data sav_ddc_bit_data = {
|
|
NULL,
|
|
bit_savddc_setsda,
|
|
bit_savddc_setscl,
|
|
bit_savddc_getsda,
|
|
bit_savddc_getscl,
|
|
CYCLE_DELAY, CYCLE_DELAY, TIMEOUT
|
|
};
|
|
|
|
static struct i2c_adapter savage4_ddc_adapter = {
|
|
"DDC Voodoo3/Banshee adapter",
|
|
I2C_HW_B_VOO,
|
|
NULL,
|
|
&sav_ddc_bit_data,
|
|
savage4_inc,
|
|
savage4_dec,
|
|
NULL,
|
|
NULL,
|
|
};
|
|
*/
|
|
/* Configures the chip */
|
|
|
|
void config_s4(struct pci_dev *dev)
|
|
{
|
|
unsigned int cadr;
|
|
|
|
/* map memory */
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,13)
|
|
cadr = dev->resource[0].start;
|
|
#else
|
|
cadr = dev->base_address[0];
|
|
#endif
|
|
cadr &= PCI_BASE_ADDRESS_MEM_MASK;
|
|
mem = ioremap_nocache(cadr, 0x0080000);
|
|
if(mem) {
|
|
// *((unsigned int *) (mem + REG2)) = 0x8160;
|
|
*((unsigned int *) (mem + REG)) = 0x00000020;
|
|
printk("i2c-savage4: Using Savage4 at 0x%p\n", mem);
|
|
}
|
|
}
|
|
|
|
/* Detect chip and initialize it. */
|
|
static int savage4_setup(void)
|
|
{
|
|
struct pci_dev *dev;
|
|
int s4_num;
|
|
|
|
s4_num = 0;
|
|
|
|
dev = NULL;
|
|
do {
|
|
if ((dev = pci_find_device(PCI_VENDOR_ID_S3,
|
|
PCI_CHIP_SAVAGE4,
|
|
dev))) {
|
|
if (!s4_num)
|
|
config_s4(dev);
|
|
s4_num++;
|
|
}
|
|
} while (dev);
|
|
|
|
dev = NULL;
|
|
do {
|
|
if ((dev = pci_find_device(PCI_VENDOR_ID_S3,
|
|
PCI_CHIP_SAVAGE2000,
|
|
dev))) {
|
|
if (!s4_num)
|
|
config_s4(dev);
|
|
s4_num++;
|
|
}
|
|
} while (dev);
|
|
|
|
if (s4_num > 0) {
|
|
if(!mem)
|
|
return -ENOMEM;
|
|
printk("i2c-savage4: %d Savage4 found.\n", s4_num);
|
|
if (s4_num > 1)
|
|
printk("i2c-savage4: warning: only 1 supported.\n");
|
|
return 0;
|
|
} else {
|
|
printk("i2c-savage4: No Savage4 found.\n");
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
void savage4_inc(struct i2c_adapter *adapter)
|
|
{
|
|
MOD_INC_USE_COUNT;
|
|
}
|
|
|
|
void savage4_dec(struct i2c_adapter *adapter)
|
|
{
|
|
MOD_DEC_USE_COUNT;
|
|
}
|
|
|
|
int __init i2c_savage4_init(void)
|
|
{
|
|
int res;
|
|
printk("i2c-savage4.o version %s (%s)\n", LM_VERSION, LM_DATE);
|
|
savage4_initialized = 0;
|
|
if ((res = savage4_setup())) {
|
|
printk
|
|
("i2c-savage4.o: Savage4 not detected, module not inserted.\n");
|
|
savage4_cleanup();
|
|
return res;
|
|
}
|
|
if ((res = i2c_bit_add_bus(&savage4_i2c_adapter))) {
|
|
printk("i2c-savage4.o: I2C adapter registration failed\n");
|
|
} else {
|
|
printk("i2c-savage4.o: I2C bus initialized\n");
|
|
savage4_initialized |= INIT2;
|
|
}
|
|
/*
|
|
if ((res = i2c_bit_add_bus(&savage4_ddc_adapter))) {
|
|
printk("i2c-savage4.o: DDC adapter registration failed\n");
|
|
} else {
|
|
printk("i2c-savage4.o: DDC bus initialized\n");
|
|
savage4_initialized |= INIT3;
|
|
}
|
|
*/
|
|
if(!(savage4_initialized & (INIT2 /* | INIT3 */ ))) {
|
|
printk("i2c-savage4.o: Both registrations failed, module not inserted\n");
|
|
savage4_cleanup();
|
|
return res;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int __init savage4_cleanup(void)
|
|
{
|
|
int res;
|
|
|
|
iounmap(mem);
|
|
/*
|
|
if (savage4_initialized & INIT3) {
|
|
if ((res = i2c_bit_del_bus(&savage4_ddc_adapter))) {
|
|
printk
|
|
("i2c-savage4.o: i2c_bit_del_bus failed, module not removed\n");
|
|
return res;
|
|
}
|
|
}
|
|
*/
|
|
if (savage4_initialized & INIT2) {
|
|
if ((res = i2c_bit_del_bus(&savage4_i2c_adapter))) {
|
|
printk
|
|
("i2c-savage4.o: i2c_bit_del_bus failed, module not removed\n");
|
|
return res;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_NO_SYMBOLS;
|
|
|
|
#ifdef MODULE
|
|
|
|
MODULE_AUTHOR
|
|
("Frodo Looijaard <frodol@dds.nl>, Philip Edelbrock <phil@netroedge.com>, Ralph Metzler <rjkm@thp.uni-koeln.de>, and Mark D. Studebaker <mdsxyz123@yahoo.com>");
|
|
MODULE_DESCRIPTION("Savage4 I2C/SMBus driver");
|
|
|
|
#ifdef MODULE_LICENSE
|
|
MODULE_LICENSE("GPL");
|
|
#endif
|
|
|
|
int init_module(void)
|
|
{
|
|
return i2c_savage4_init();
|
|
}
|
|
|
|
int cleanup_module(void)
|
|
{
|
|
return savage4_cleanup();
|
|
}
|
|
|
|
#endif /* MODULE */
|