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
 | 
