170 lines
4.7 KiB
C
170 lines
4.7 KiB
C
|
/*
|
||
|
|
* Interface for smsc fdc48m81x Super IO chip
|
||
|
|
*
|
||
|
|
* Author: MontaVista Software, Inc. source@mvista.com
|
||
|
|
*
|
||
|
|
* 2001-2003 (c) MontaVista Software, Inc. This file is licensed under
|
||
|
|
* the terms of the GNU General Public License version 2. This program
|
||
|
|
* is licensed "as is" without any warranty of any kind, whether express
|
||
|
|
* or implied.
|
||
|
|
*
|
||
|
|
* Copyright 2004 (c) MontaVista Software, Inc.
|
||
|
|
*/
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/types.h>
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <asm/txx9/smsc_fdc37m81x.h>
|
||
|
|
|
||
|
|
/* Common Registers */
|
||
|
|
#define SMSC_FDC37M81X_CONFIG_INDEX 0x00
|
||
|
|
#define SMSC_FDC37M81X_CONFIG_DATA 0x01
|
||
|
|
#define SMSC_FDC37M81X_CONF 0x02
|
||
|
|
#define SMSC_FDC37M81X_INDEX 0x03
|
||
|
|
#define SMSC_FDC37M81X_DNUM 0x07
|
||
|
|
#define SMSC_FDC37M81X_DID 0x20
|
||
|
|
#define SMSC_FDC37M81X_DREV 0x21
|
||
|
|
#define SMSC_FDC37M81X_PCNT 0x22
|
||
|
|
#define SMSC_FDC37M81X_PMGT 0x23
|
||
|
|
#define SMSC_FDC37M81X_OSC 0x24
|
||
|
|
#define SMSC_FDC37M81X_CONFPA0 0x26
|
||
|
|
#define SMSC_FDC37M81X_CONFPA1 0x27
|
||
|
|
#define SMSC_FDC37M81X_TEST4 0x2B
|
||
|
|
#define SMSC_FDC37M81X_TEST5 0x2C
|
||
|
|
#define SMSC_FDC37M81X_TEST1 0x2D
|
||
|
|
#define SMSC_FDC37M81X_TEST2 0x2E
|
||
|
|
#define SMSC_FDC37M81X_TEST3 0x2F
|
||
|
|
|
||
|
|
/* Logical device numbers */
|
||
|
|
#define SMSC_FDC37M81X_FDD 0x00
|
||
|
|
#define SMSC_FDC37M81X_SERIAL1 0x04
|
||
|
|
#define SMSC_FDC37M81X_SERIAL2 0x05
|
||
|
|
#define SMSC_FDC37M81X_KBD 0x07
|
||
|
|
|
||
|
|
/* Logical device Config Registers */
|
||
|
|
#define SMSC_FDC37M81X_ACTIVE 0x30
|
||
|
|
#define SMSC_FDC37M81X_BASEADDR0 0x60
|
||
|
|
#define SMSC_FDC37M81X_BASEADDR1 0x61
|
||
|
|
#define SMSC_FDC37M81X_INT 0x70
|
||
|
|
#define SMSC_FDC37M81X_INT2 0x72
|
||
|
|
#define SMSC_FDC37M81X_MODE 0xF0
|
||
|
|
|
||
|
|
/* Chip Config Values */
|
||
|
|
#define SMSC_FDC37M81X_CONFIG_ENTER 0x55
|
||
|
|
#define SMSC_FDC37M81X_CONFIG_EXIT 0xaa
|
||
|
|
#define SMSC_FDC37M81X_CHIP_ID 0x4d
|
||
|
|
|
||
|
|
static unsigned long g_smsc_fdc37m81x_base;
|
||
|
|
|
||
|
|
static inline unsigned char smsc_fdc37m81x_rd(unsigned char index)
|
||
|
|
{
|
||
|
|
outb(index, g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_INDEX);
|
||
|
|
|
||
|
|
return inb(g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_DATA);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void smsc_dc37m81x_wr(unsigned char index, unsigned char data)
|
||
|
|
{
|
||
|
|
outb(index, g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_INDEX);
|
||
|
|
outb(data, g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_DATA);
|
||
|
|
}
|
||
|
|
|
||
|
|
void smsc_fdc37m81x_config_beg(void)
|
||
|
|
{
|
||
|
|
if (g_smsc_fdc37m81x_base) {
|
||
|
|
outb(SMSC_FDC37M81X_CONFIG_ENTER,
|
||
|
|
g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_INDEX);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void smsc_fdc37m81x_config_end(void)
|
||
|
|
{
|
||
|
|
if (g_smsc_fdc37m81x_base)
|
||
|
|
outb(SMSC_FDC37M81X_CONFIG_EXIT,
|
||
|
|
g_smsc_fdc37m81x_base + SMSC_FDC37M81X_CONFIG_INDEX);
|
||
|
|
}
|
||
|
|
|
||
|
|
u8 smsc_fdc37m81x_config_get(u8 reg)
|
||
|
|
{
|
||
|
|
u8 val = 0;
|
||
|
|
|
||
|
|
if (g_smsc_fdc37m81x_base)
|
||
|
|
val = smsc_fdc37m81x_rd(reg);
|
||
|
|
|
||
|
|
return val;
|
||
|
|
}
|
||
|
|
|
||
|
|
void smsc_fdc37m81x_config_set(u8 reg, u8 val)
|
||
|
|
{
|
||
|
|
if (g_smsc_fdc37m81x_base)
|
||
|
|
smsc_dc37m81x_wr(reg, val);
|
||
|
|
}
|
||
|
|
|
||
|
|
unsigned long __init smsc_fdc37m81x_init(unsigned long port)
|
||
|
|
{
|
||
|
|
const int field = sizeof(unsigned long) * 2;
|
||
|
|
u8 chip_id;
|
||
|
|
|
||
|
|
if (g_smsc_fdc37m81x_base)
|
||
|
|
pr_warn("%s: stepping on old base=0x%0*lx\n", __func__, field,
|
||
|
|
g_smsc_fdc37m81x_base);
|
||
|
|
|
||
|
|
g_smsc_fdc37m81x_base = port;
|
||
|
|
|
||
|
|
smsc_fdc37m81x_config_beg();
|
||
|
|
|
||
|
|
chip_id = smsc_fdc37m81x_rd(SMSC_FDC37M81X_DID);
|
||
|
|
if (chip_id == SMSC_FDC37M81X_CHIP_ID)
|
||
|
|
smsc_fdc37m81x_config_end();
|
||
|
|
else {
|
||
|
|
pr_warn("%s: unknown chip id 0x%02x\n", __func__, chip_id);
|
||
|
|
g_smsc_fdc37m81x_base = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return g_smsc_fdc37m81x_base;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef DEBUG
|
||
|
|
static void smsc_fdc37m81x_config_dump_one(const char *key, u8 dev, u8 reg)
|
||
|
|
{
|
||
|
|
pr_info("%s: dev=0x%02x reg=0x%02x val=0x%02x\n", key, dev, reg,
|
||
|
|
smsc_fdc37m81x_rd(reg));
|
||
|
|
}
|
||
|
|
|
||
|
|
void smsc_fdc37m81x_config_dump(void)
|
||
|
|
{
|
||
|
|
u8 orig;
|
||
|
|
const char *fname = __func__;
|
||
|
|
|
||
|
|
smsc_fdc37m81x_config_beg();
|
||
|
|
|
||
|
|
orig = smsc_fdc37m81x_rd(SMSC_FDC37M81X_DNUM);
|
||
|
|
|
||
|
|
pr_info("%s: common\n", fname);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_NONE,
|
||
|
|
SMSC_FDC37M81X_DNUM);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_NONE,
|
||
|
|
SMSC_FDC37M81X_DID);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_NONE,
|
||
|
|
SMSC_FDC37M81X_DREV);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_NONE,
|
||
|
|
SMSC_FDC37M81X_PCNT);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_NONE,
|
||
|
|
SMSC_FDC37M81X_PMGT);
|
||
|
|
|
||
|
|
pr_info("%s: keyboard\n", fname);
|
||
|
|
smsc_dc37m81x_wr(SMSC_FDC37M81X_DNUM, SMSC_FDC37M81X_KBD);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_KBD,
|
||
|
|
SMSC_FDC37M81X_ACTIVE);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_KBD,
|
||
|
|
SMSC_FDC37M81X_INT);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_KBD,
|
||
|
|
SMSC_FDC37M81X_INT2);
|
||
|
|
smsc_fdc37m81x_config_dump_one(fname, SMSC_FDC37M81X_KBD,
|
||
|
|
SMSC_FDC37M81X_LDCR_F0);
|
||
|
|
|
||
|
|
smsc_dc37m81x_wr(SMSC_FDC37M81X_DNUM, orig);
|
||
|
|
|
||
|
|
smsc_fdc37m81x_config_end();
|
||
|
|
}
|
||
|
|
#endif
|