[linux-2.6-block.git] / drivers / pcmcia / m32r_pcc.c

/*
 *  drivers/pcmcia/m32r_pcc.c
 *
 *  Device driver for the PCMCIA functionality of M32R.
 *
 *  Copyright (c) 2001, 2002, 2003, 2004
 *    Hiroyuki Kondo, Naoto Sugai, Hayato Fujiwara
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/timer.h>
#include <linux/ioport.h>
#include <linux/delay.h>
#include <linux/workqueue.h>
#include <linux/interrupt.h>
#include <linux/platform_device.h>
#include <linux/bitops.h>
#include <asm/irq.h>
#include <asm/io.h>
#include <asm/addrspace.h>

#include <pcmcia/ss.h>

/* XXX: should be moved into asm/irq.h */
#define PCC0_IRQ 24
#define PCC1_IRQ 25

#include "m32r_pcc.h"

#define CHAOS_PCC_DEBUG
#ifdef CHAOS_PCC_DEBUG
	static volatile u_short dummy_readbuf;
#endif

#define PCC_DEBUG_DBEX


/* Poll status interval -- 0 means default to interrupt */
static int poll_interval = 0;

typedef enum pcc_space { as_none = 0, as_comm, as_attr, as_io } pcc_as_t;

typedef struct pcc_socket {
	u_short			type, flags;
	struct pcmcia_socket	socket;
	unsigned int		number;
	unsigned int		ioaddr;
	u_long			mapaddr;
	u_long			base;	/* PCC register base */
	u_char			cs_irq, intr;
	pccard_io_map		io_map[MAX_IO_WIN];
	pccard_mem_map		mem_map[MAX_WIN];
	u_char			io_win;
	u_char			mem_win;
	pcc_as_t		current_space;
	u_char			last_iodbex;
#ifdef CHAOS_PCC_DEBUG
	u_char			last_iosize;
#endif
#ifdef CONFIG_PROC_FS
	struct proc_dir_entry *proc;
#endif
} pcc_socket_t;

static int pcc_sockets = 0;
static pcc_socket_t socket[M32R_MAX_PCC] = {
	{ 0, }, /* ... */
};

/*====================================================================*/

static unsigned int pcc_get(u_short, unsigned int);
static void pcc_set(u_short, unsigned int , unsigned int );

static DEFINE_SPINLOCK(pcc_lock);

void pcc_iorw(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int wr, int flag)
{
	u_long addr;
	u_long flags;
	int need_ex;
#ifdef PCC_DEBUG_DBEX
	int _dbex;
#endif
	pcc_socket_t *t = &socket[sock];
#ifdef CHAOS_PCC_DEBUG
	int map_changed = 0;
#endif

	/* Need lock ? */
	spin_lock_irqsave(&pcc_lock, flags);

	/*
	 * Check if need dbex
	 */
	need_ex = (size > 1 && flag == 0) ? PCMOD_DBEX : 0;
#ifdef PCC_DEBUG_DBEX
	_dbex = need_ex;
	need_ex = 0;
#endif

	/*
	 * calculate access address
	 */
	addr = t->mapaddr + port - t->ioaddr + KSEG1; /* XXX */

	/*
	 * Check current mapping
	 */
	if (t->current_space != as_io || t->last_iodbex != need_ex) {

		u_long cbsz;

		/*
		 * Disable first
		 */
		pcc_set(sock, PCCR, 0);

		/*
		 * Set mode and io address
		 */
		cbsz = (t->flags & MAP_16BIT) ? 0 : PCMOD_CBSZ;
		pcc_set(sock, PCMOD, PCMOD_AS_IO | cbsz | need_ex);
		pcc_set(sock, PCADR, addr & 0x1ff00000);

		/*
		 * Enable and read it
		 */
		pcc_set(sock, PCCR, 1);

#ifdef CHAOS_PCC_DEBUG
#if 0
		map_changed = (t->current_space == as_attr && size == 2); /* XXX */
#else
		map_changed = 1;
#endif
#endif
		t->current_space = as_io;
	}

	/*
	 * access to IO space
	 */
	if (size == 1) {
		/* Byte */
		unsigned char *bp = (unsigned char *)buf;

#ifdef CHAOS_DEBUG
		if (map_changed) {
			dummy_readbuf = readb(addr);
		}
#endif
		if (wr) {
			/* write Byte */
			while (nmemb--) {
				writeb(*bp++, addr);
			}
		} else {
			/* read Byte */
			while (nmemb--) {
	    		*bp++ = readb(addr);
			}
		}
	} else {
		/* Word */
		unsigned short *bp = (unsigned short *)buf;

#ifdef CHAOS_PCC_DEBUG
		if (map_changed) {
			dummy_readbuf = readw(addr);
		}
#endif
		if (wr) {
			/* write Word */
			while (nmemb--) {
#ifdef PCC_DEBUG_DBEX
				if (_dbex) {
					unsigned char *cp = (unsigned char *)bp;
					unsigned short tmp;
					tmp = cp[1] << 8 | cp[0];
					writew(tmp, addr);
					bp++;
				} else
#endif
				writew(*bp++, addr);
	    	}
	    } else {
	    	/* read Word */
	    	while (nmemb--) {
#ifdef  PCC_DEBUG_DBEX
				if (_dbex) {
					unsigned char *cp = (unsigned char *)bp;
					unsigned short tmp;
					tmp = readw(addr);
					cp[0] = tmp & 0xff;
					cp[1] = (tmp >> 8) & 0xff;
					bp++;
				} else
#endif
				*bp++ = readw(addr);
	    	}
	    }
	}

#if 1
	/* addr is no longer used */
	if ((addr = pcc_get(sock, PCIRC)) & PCIRC_BWERR) {
	  printk("m32r_pcc: BWERR detected : port 0x%04lx : iosize %dbit\n",
			 port, size * 8);
	  pcc_set(sock, PCIRC, addr);
	}
#endif
	/*
	 * save state
	 */
	t->last_iosize = size;
	t->last_iodbex = need_ex;

	/* Need lock ? */

	spin_unlock_irqrestore(&pcc_lock,flags);

	return;
}

void pcc_ioread(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int flag) {
	pcc_iorw(sock, port, buf, size, nmemb, 0, flag);
}

void pcc_iowrite(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int flag) {
    pcc_iorw(sock, port, buf, size, nmemb, 1, flag);
}

/*====================================================================*/

#define IS_REGISTERED		0x2000
#define IS_ALIVE		0x8000

typedef struct pcc_t {
	char			*name;
	u_short			flags;
} pcc_t;

static pcc_t pcc[] = {
	{ "xnux2", 0 }, { "xnux2", 0 },
};

static irqreturn_t pcc_interrupt(int, void *);

/*====================================================================*/

static struct timer_list poll_timer;

static unsigned int pcc_get(u_short sock, unsigned int reg)
{
	return inl(socket[sock].base + reg);
}


static void pcc_set(u_short sock, unsigned int reg, unsigned int data)
{
  	outl(data, socket[sock].base + reg);
}

/*======================================================================

	See if a card is present, powered up, in IO mode, and already
	bound to a (non PC Card) Linux driver.  We leave these alone.

	We make an exception for cards that seem to be serial devices.

======================================================================*/

static int __init is_alive(u_short sock)
{
	unsigned int stat;
	unsigned int f;

	stat = pcc_get(sock, PCIRC);
	f = (stat & (PCIRC_CDIN1 | PCIRC_CDIN2)) >> 16;
	if(!f){
		printk("m32r_pcc: No Card is detected at socket %d : stat = 0x%08x\n",stat,sock);
		return 0;
	}
	if(f!=3)
		printk("m32r_pcc: Insertion fail (%.8x) at socket %d\n",stat,sock);
	else
		printk("m32r_pcc: Card is Inserted at socket %d(%.8x)\n",sock,stat);
	return 0;
}

static int add_pcc_socket(ulong base, int irq, ulong mapaddr,
			  unsigned int ioaddr)
{
  	pcc_socket_t *t = &socket[pcc_sockets];
	int err;

	/* add sockets */
	t->ioaddr = ioaddr;
	t->mapaddr = mapaddr;
	t->base = base;
#ifdef CHAOS_PCC_DEBUG
	t->flags = MAP_16BIT;
#else
	t->flags = 0;
#endif
	if (is_alive(pcc_sockets))
		t->flags |= IS_ALIVE;

	/* add pcc */
	if (t->base > 0) {
		request_region(t->base, 0x20, "m32r-pcc");
	}

	printk(KERN_INFO "  %s ", pcc[pcc_sockets].name);
	printk("pcc at 0x%08lx\n", t->base);

	/* Update socket interrupt information, capabilities */
	t->socket.features |= (SS_CAP_PCCARD | SS_CAP_STATIC_MAP);
	t->socket.map_size = M32R_PCC_MAPSIZE;
	t->socket.io_offset = ioaddr;	/* use for io access offset */
	t->socket.irq_mask = 0;
	t->socket.pci_irq = 2 + pcc_sockets; /* XXX */

	err = request_irq(irq, pcc_interrupt, 0, "m32r-pcc", pcc_interrupt);
	if (err) {
		if (t->base > 0)
			release_region(t->base, 0x20);
		return err;
	}

	pcc_sockets++;

	return 0;
}


/*====================================================================*/

static irqreturn_t pcc_interrupt(int irq, void *dev)
{
	int i, j, irc;
	u_int events, active;
	int handled = 0;

	pr_debug("m32r_pcc: pcc_interrupt(%d)\n", irq);

	for (j = 0; j < 20; j++) {
		active = 0;
		for (i = 0; i < pcc_sockets; i++) {
			if ((socket[i].cs_irq != irq) &&
				(socket[i].socket.pci_irq != irq))
				continue;
			handled = 1;
			irc = pcc_get(i, PCIRC);
			irc >>=16;
			pr_debug("m32r_pcc: interrupt: socket %d pcirc 0x%02x ",
				i, irc);
			if (!irc)
				continue;

			events = (irc) ? SS_DETECT : 0;
			events |= (pcc_get(i,PCCR) & PCCR_PCEN) ? SS_READY : 0;
			pr_debug("m32r_pcc: event 0x%02x\n", events);

			if (events)
				pcmcia_parse_events(&socket[i].socket, events);

			active |= events;
			active = 0;
		}
		if (!active) break;
	}
	if (j == 20)
		printk(KERN_NOTICE "m32r-pcc: infinite loop in interrupt handler\n");

	pr_debug("m32r_pcc: interrupt done\n");

	return IRQ_RETVAL(handled);
} /* pcc_interrupt */

static void pcc_interrupt_wrapper(u_long data)
{
	pcc_interrupt(0, NULL);
	init_timer(&poll_timer);
	poll_timer.expires = jiffies + poll_interval;
	add_timer(&poll_timer);
}

/*====================================================================*/

static int _pcc_get_status(u_short sock, u_int *value)
{
	u_int status;

	status = pcc_get(sock,PCIRC);
	*value = ((status & PCIRC_CDIN1) && (status & PCIRC_CDIN2))
		? SS_DETECT : 0;

	status = pcc_get(sock,PCCR);

#if 0
	*value |= (status & PCCR_PCEN) ? SS_READY : 0;
#else
	*value |= SS_READY; /* XXX: always */
#endif

	status = pcc_get(sock,PCCSIGCR);
	*value |= (status & PCCSIGCR_VEN) ? SS_POWERON : 0;

	pr_debug("m32r_pcc: GetStatus(%d) = %#4.4x\n", sock, *value);
	return 0;
} /* _get_status */

/*====================================================================*/

static int _pcc_set_socket(u_short sock, socket_state_t *state)
{
	u_long reg = 0;

	pr_debug("m32r_pcc: SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
		  "io_irq %d, csc_mask %#2.2x)", sock, state->flags,
		  state->Vcc, state->Vpp, state->io_irq, state->csc_mask);

	if (state->Vcc) {
		/*
		 * 5V only
		 */
		if (state->Vcc == 50) {
			reg |= PCCSIGCR_VEN;
		} else {
			return -EINVAL;
		}
	}

	if (state->flags & SS_RESET) {
		pr_debug("m32r_pcc: :RESET\n");
		reg |= PCCSIGCR_CRST;
	}
	if (state->flags & SS_OUTPUT_ENA){
		pr_debug("m32r_pcc: :OUTPUT_ENA\n");
		/* bit clear */
	} else {
		reg |= PCCSIGCR_SEN;
	}

	pcc_set(sock,PCCSIGCR,reg);

	if(state->flags & SS_IOCARD){
		pr_debug("m32r_pcc: :IOCARD");
	}
	if (state->flags & SS_PWR_AUTO) {
		pr_debug("m32r_pcc: :PWR_AUTO");
	}
	if (state->csc_mask & SS_DETECT)
		pr_debug("m32r_pcc: :csc-SS_DETECT");
	if (state->flags & SS_IOCARD) {
		if (state->csc_mask & SS_STSCHG)
			pr_debug("m32r_pcc: :STSCHG");
	} else {
		if (state->csc_mask & SS_BATDEAD)
			pr_debug("m32r_pcc: :BATDEAD");
		if (state->csc_mask & SS_BATWARN)
			pr_debug("m32r_pcc: :BATWARN");
		if (state->csc_mask & SS_READY)
			pr_debug("m32r_pcc: :READY");
	}
	pr_debug("m32r_pcc: \n");
	return 0;
} /* _set_socket */

/*====================================================================*/

static int _pcc_set_io_map(u_short sock, struct pccard_io_map *io)
{
	u_char map;

	pr_debug("m32r_pcc: SetIOMap(%d, %d, %#2.2x, %d ns, "
		  "%#llx-%#llx)\n", sock, io->map, io->flags,
		  io->speed, (unsigned long long)io->start,
		  (unsigned long long)io->stop);
	map = io->map;

	return 0;
} /* _set_io_map */

/*====================================================================*/

static int _pcc_set_mem_map(u_short sock, struct pccard_mem_map *mem)
{

	u_char map = mem->map;
	u_long mode;
	u_long addr;
	pcc_socket_t *t = &socket[sock];
#ifdef CHAOS_PCC_DEBUG
#if 0
	pcc_as_t last = t->current_space;
#endif
#endif

	pr_debug("m32r_pcc: SetMemMap(%d, %d, %#2.2x, %d ns, "
		 "%#llx,  %#x)\n", sock, map, mem->flags,
		 mem->speed, (unsigned long long)mem->static_start,
		 mem->card_start);

	/*
	 * sanity check
	 */
	if ((map > MAX_WIN) || (mem->card_start > 0x3ffffff)){
		return -EINVAL;
	}

	/*
	 * de-activate
	 */
	if ((mem->flags & MAP_ACTIVE) == 0) {
		t->current_space = as_none;
		return 0;
	}

	/*
	 * Disable first
	 */
	pcc_set(sock, PCCR, 0);

	/*
	 * Set mode
	 */
	if (mem->flags & MAP_ATTRIB) {
		mode = PCMOD_AS_ATTRIB | PCMOD_CBSZ;
		t->current_space = as_attr;
	} else {
		mode = 0; /* common memory */
		t->current_space = as_comm;
	}
	pcc_set(sock, PCMOD, mode);

	/*
	 * Set address
	 */
	addr = t->mapaddr + (mem->card_start & M32R_PCC_MAPMASK);
	pcc_set(sock, PCADR, addr);

	mem->static_start = addr + mem->card_start;

	/*
	 * Enable again
	 */
	pcc_set(sock, PCCR, 1);

#ifdef CHAOS_PCC_DEBUG
#if 0
	if (last != as_attr) {
#else
	if (1) {
#endif
		dummy_readbuf = *(u_char *)(addr + KSEG1);
	}
#endif

	return 0;

} /* _set_mem_map */

#if 0 /* driver model ordering issue */
/*======================================================================

	Routines for accessing socket information and register dumps via
	/proc/bus/pccard/...

======================================================================*/

static ssize_t show_info(struct class_device *class_dev, char *buf)
{
	pcc_socket_t *s = container_of(class_dev, struct pcc_socket,
		socket.dev);

	return sprintf(buf, "type:     %s\nbase addr:    0x%08lx\n",
		pcc[s->type].name, s->base);
}

static ssize_t show_exca(struct class_device *class_dev, char *buf)
{
	/* FIXME */

	return 0;
}

static CLASS_DEVICE_ATTR(info, S_IRUGO, show_info, NULL);
static CLASS_DEVICE_ATTR(exca, S_IRUGO, show_exca, NULL);
#endif

/*====================================================================*/

/* this is horribly ugly... proper locking needs to be done here at
 * some time... */
#define LOCKED(x) do {					\
	int retval;					\
	unsigned long flags;				\
	spin_lock_irqsave(&pcc_lock, flags);		\
	retval = x;					\
	spin_unlock_irqrestore(&pcc_lock, flags);	\
	return retval;					\
} while (0)


static int pcc_get_status(struct pcmcia_socket *s, u_int *value)
{
	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;

	if (socket[sock].flags & IS_ALIVE) {
		*value = 0;
		return -EINVAL;
	}
	LOCKED(_pcc_get_status(sock, value));
}

static int pcc_set_socket(struct pcmcia_socket *s, socket_state_t *state)
{
	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;

	if (socket[sock].flags & IS_ALIVE)
		return -EINVAL;

	LOCKED(_pcc_set_socket(sock, state));
}

static int pcc_set_io_map(struct pcmcia_socket *s, struct pccard_io_map *io)
{
	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;

	if (socket[sock].flags & IS_ALIVE)
		return -EINVAL;
	LOCKED(_pcc_set_io_map(sock, io));
}

static int pcc_set_mem_map(struct pcmcia_socket *s, struct pccard_mem_map *mem)
{
	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;

	if (socket[sock].flags & IS_ALIVE)
		return -EINVAL;
	LOCKED(_pcc_set_mem_map(sock, mem));
}

static int pcc_init(struct pcmcia_socket *s)
{
	pr_debug("m32r_pcc: init call\n");
	return 0;
}

static struct pccard_operations pcc_operations = {
	.init			= pcc_init,
	.get_status		= pcc_get_status,
	.set_socket		= pcc_set_socket,
	.set_io_map		= pcc_set_io_map,
	.set_mem_map		= pcc_set_mem_map,
};

/*====================================================================*/

static struct platform_driver pcc_driver = {
	.driver = {
		.name		= "pcc",
	},
};

static struct platform_device pcc_device = {
	.name = "pcc",
	.id = 0,
};

/*====================================================================*/

static int __init init_m32r_pcc(void)
{
	int i, ret;

	ret = platform_driver_register(&pcc_driver);
	if (ret)
		return ret;

	ret = platform_device_register(&pcc_device);
	if (ret)
		goto unreg_driv;

	printk(KERN_INFO "m32r PCC probe:\n");

	pcc_sockets = 0;

	ret = add_pcc_socket(M32R_PCC0_BASE, PCC0_IRQ, M32R_PCC0_MAPBASE,
			     0x1000);
	if (ret)
		goto unreg_dev;

#ifdef CONFIG_M32RPCC_SLOT2
	ret = add_pcc_socket(M32R_PCC1_BASE, PCC1_IRQ, M32R_PCC1_MAPBASE,
			     0x2000);
	if (ret)
		goto unreg_dev;
#endif

	if (pcc_sockets == 0) {
		printk("socket is not found.\n");
		ret = -ENODEV;
		goto unreg_dev;
	}

	/* Set up interrupt handler(s) */

	for (i = 0 ; i < pcc_sockets ; i++) {
		socket[i].socket.dev.parent = &pcc_device.dev;
		socket[i].socket.ops = &pcc_operations;
		socket[i].socket.resource_ops = &pccard_static_ops;
		socket[i].socket.owner = THIS_MODULE;
		socket[i].number = i;
		ret = pcmcia_register_socket(&socket[i].socket);
		if (!ret)
			socket[i].flags |= IS_REGISTERED;
	}

	/* Finally, schedule a polling interrupt */
	if (poll_interval != 0) {
		poll_timer.function = pcc_interrupt_wrapper;
		poll_timer.data = 0;
		init_timer(&poll_timer);
		poll_timer.expires = jiffies + poll_interval;
		add_timer(&poll_timer);
	}

	return 0;

unreg_dev:
	platform_device_unregister(&pcc_device);
unreg_driv:
	platform_driver_unregister(&pcc_driver);
	return ret;
} /* init_m32r_pcc */

static void __exit exit_m32r_pcc(void)
{
	int i;

	for (i = 0; i < pcc_sockets; i++)
		if (socket[i].flags & IS_REGISTERED)
			pcmcia_unregister_socket(&socket[i].socket);

	platform_device_unregister(&pcc_device);
	if (poll_interval != 0)
		del_timer_sync(&poll_timer);

	platform_driver_unregister(&pcc_driver);
} /* exit_m32r_pcc */

module_init(init_m32r_pcc);
module_exit(exit_m32r_pcc);
MODULE_LICENSE("Dual MPL/GPL");
/*====================================================================*/
Commit	Line	Data
1da177e4 LT	1	/*
	2	* drivers/pcmcia/m32r_pcc.c
	3	*
	4	* Device driver for the PCMCIA functionality of M32R.
	5	*
	6	* Copyright (c) 2001, 2002, 2003, 2004
	7	* Hiroyuki Kondo, Naoto Sugai, Hayato Fujiwara
	8	*/
	9
	10	#include <linux/module.h>
	11	#include <linux/moduleparam.h>
	12	#include <linux/init.h>
1da177e4 LT	13	#include <linux/types.h>
	14	#include <linux/fcntl.h>
	15	#include <linux/string.h>
	16	#include <linux/kernel.h>
	17	#include <linux/errno.h>
	18	#include <linux/timer.h>
1da177e4 LT	19	#include <linux/ioport.h>
	20	#include <linux/delay.h>
	21	#include <linux/workqueue.h>
	22	#include <linux/interrupt.h>
d052d1be	23	#include <linux/platform_device.h>
1977f032	24	#include <linux/bitops.h>
1da177e4 LT	25	#include <asm/irq.h>
1da177e4 LT	26	#include <asm/io.h>
1da177e4 LT	27	#include <asm/addrspace.h>
1da177e4 LT	28
1da177e4	29	#include <pcmcia/ss.h>
1da177e4 LT	30
	31	/* XXX: should be moved into asm/irq.h */
	32	#define PCC0_IRQ 24
	33	#define PCC1_IRQ 25
	34
	35	#include "m32r_pcc.h"
	36
	37	#define CHAOS_PCC_DEBUG
	38	#ifdef CHAOS_PCC_DEBUG
	39	static volatile u_short dummy_readbuf;
	40	#endif
	41
	42	#define PCC_DEBUG_DBEX
	43
1da177e4 LT	44
	45	/* Poll status interval -- 0 means default to interrupt */
	46	static int poll_interval = 0;
	47
	48	typedef enum pcc_space { as_none = 0, as_comm, as_attr, as_io } pcc_as_t;
	49
	50	typedef struct pcc_socket {
	51	u_short type, flags;
	52	struct pcmcia_socket socket;
	53	unsigned int number;
906da809	54	unsigned int ioaddr;
1da177e4 LT	55	u_long mapaddr;
	56	u_long base; /* PCC register base */
	57	u_char cs_irq, intr;
	58	pccard_io_map io_map[MAX_IO_WIN];
	59	pccard_mem_map mem_map[MAX_WIN];
	60	u_char io_win;
	61	u_char mem_win;
	62	pcc_as_t current_space;
	63	u_char last_iodbex;
	64	#ifdef CHAOS_PCC_DEBUG
	65	u_char last_iosize;
	66	#endif
	67	#ifdef CONFIG_PROC_FS
	68	struct proc_dir_entry *proc;
	69	#endif
	70	} pcc_socket_t;
	71
	72	static int pcc_sockets = 0;
	73	static pcc_socket_t socket[M32R_MAX_PCC] = {
	74	{ 0, }, /* ... */
	75	};
	76
	77	/====================================================================/
	78
	79	static unsigned int pcc_get(u_short, unsigned int);
	80	static void pcc_set(u_short, unsigned int , unsigned int );
	81
	82	static DEFINE_SPINLOCK(pcc_lock);
	83
	84	void pcc_iorw(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int wr, int flag)
	85	{
	86	u_long addr;
	87	u_long flags;
	88	int need_ex;
	89	#ifdef PCC_DEBUG_DBEX
	90	int _dbex;
	91	#endif
	92	pcc_socket_t *t = &socket[sock];
	93	#ifdef CHAOS_PCC_DEBUG
	94	int map_changed = 0;
	95	#endif
	96
	97	/* Need lock ? */
	98	spin_lock_irqsave(&pcc_lock, flags);
	99
	100	/*
	101	* Check if need dbex
	102	*/
	103	need_ex = (size > 1 && flag == 0) ? PCMOD_DBEX : 0;
	104	#ifdef PCC_DEBUG_DBEX
	105	_dbex = need_ex;
	106	need_ex = 0;
	107	#endif
	108
	109	/*
	110	* calculate access address
	111	*/
	112	addr = t->mapaddr + port - t->ioaddr + KSEG1; /* XXX */
	113
	114	/*
	115	* Check current mapping
	116	*/
	117	if (t->current_space != as_io \|\| t->last_iodbex != need_ex) {
	118
119	u_long cbsz;
120
121	/*
122	* Disable first
123	*/
124	pcc_set(sock, PCCR, 0);
125
126	/*
127	* Set mode and io address
128	*/
129	cbsz = (t->flags & MAP_16BIT) ? 0 : PCMOD_CBSZ;
130	pcc_set(sock, PCMOD, PCMOD_AS_IO \| cbsz \| need_ex);
131	pcc_set(sock, PCADR, addr & 0x1ff00000);
132
133	/*
134	* Enable and read it
135	*/
136	pcc_set(sock, PCCR, 1);
137
138	#ifdef CHAOS_PCC_DEBUG
139	#if 0
140	map_changed = (t->current_space == as_attr && size == 2); /* XXX */
141	#else
142	map_changed = 1;
143	#endif
144	#endif
145	t->current_space = as_io;
146	}
147
148	/*
149	* access to IO space
150	*/
151	if (size == 1) {
152	/* Byte */
153	unsigned char bp = (unsigned char )buf;
154
155	#ifdef CHAOS_DEBUG
156	if (map_changed) {
157	dummy_readbuf = readb(addr);
158	}
159	#endif
160	if (wr) {
161	/* write Byte */
162	while (nmemb--) {
163	writeb(*bp++, addr);
164	}
165	} else {
166	/* read Byte */
167	while (nmemb--) {
168	*bp++ = readb(addr);
169	}
170	}
171	} else {
172	/* Word */
173	unsigned short bp = (unsigned short )buf;
174
175	#ifdef CHAOS_PCC_DEBUG
176	if (map_changed) {
177	dummy_readbuf = readw(addr);
178	}
179	#endif
180	if (wr) {
181	/* write Word */
182	while (nmemb--) {
183	#ifdef PCC_DEBUG_DBEX
184	if (_dbex) {
185	unsigned char cp = (unsigned char )bp;
186	unsigned short tmp;
187	tmp = cp[1] << 8 \| cp[0];
188	writew(tmp, addr);
189	bp++;
190	} else
191	#endif
192	writew(*bp++, addr);
193	}
194	} else {
195	/* read Word */
196	while (nmemb--) {
197	#ifdef PCC_DEBUG_DBEX
198	if (_dbex) {
199	unsigned char cp = (unsigned char )bp;
200	unsigned short tmp;
201	tmp = readw(addr);
202	cp[0] = tmp & 0xff;
203	cp[1] = (tmp >> 8) & 0xff;
204	bp++;
205	} else
206	#endif
207	*bp++ = readw(addr);
208	}
209	}
210	}
211
212	#if 1
213	/* addr is no longer used */
214	if ((addr = pcc_get(sock, PCIRC)) & PCIRC_BWERR) {
215	printk("m32r_pcc: BWERR detected : port 0x%04lx : iosize %dbit\n",
216	port, size * 8);
217	pcc_set(sock, PCIRC, addr);
218	}
219	#endif
220	/*
221	* save state
222	*/
223	t->last_iosize = size;
224	t->last_iodbex = need_ex;
225
226	/* Need lock ? */
227
228	spin_unlock_irqrestore(&pcc_lock,flags);
229
230	return;
231	}
232
233	void pcc_ioread(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int flag) {
234	pcc_iorw(sock, port, buf, size, nmemb, 0, flag);
235	}
236
237	void pcc_iowrite(int sock, unsigned long port, void *buf, size_t size, size_t nmemb, int flag) {
238	pcc_iorw(sock, port, buf, size, nmemb, 1, flag);
239	}
240
241	/====================================================================/
242
243	#define IS_REGISTERED 0x2000
244	#define IS_ALIVE 0x8000
245
246	typedef struct pcc_t {
247	char *name;
248	u_short flags;
249	} pcc_t;
250
251	static pcc_t pcc[] = {
252	{ "xnux2", 0 }, { "xnux2", 0 },
253	};
254
7d12e780	255	static irqreturn_t pcc_interrupt(int, void *);
1da177e4 LT	256
	257	/====================================================================/
	258
	259	static struct timer_list poll_timer;
	260
	261	static unsigned int pcc_get(u_short sock, unsigned int reg)
	262	{
	263	return inl(socket[sock].base + reg);
	264	}
	265
	266
	267	static void pcc_set(u_short sock, unsigned int reg, unsigned int data)
	268	{
	269	outl(data, socket[sock].base + reg);
	270	}
	271
	272	/*======================================================================
	273
	274	See if a card is present, powered up, in IO mode, and already
	275	bound to a (non PC Card) Linux driver. We leave these alone.
	276
	277	We make an exception for cards that seem to be serial devices.
	278
	279	======================================================================*/
	280
	281	static int __init is_alive(u_short sock)
	282	{
	283	unsigned int stat;
	284	unsigned int f;
	285
	286	stat = pcc_get(sock, PCIRC);
	287	f = (stat & (PCIRC_CDIN1 \| PCIRC_CDIN2)) >> 16;
	288	if(!f){
	289	printk("m32r_pcc: No Card is detected at socket %d : stat = 0x%08x\n",stat,sock);
	290	return 0;
	291	}
	292	if(f!=3)
	293	printk("m32r_pcc: Insertion fail (%.8x) at socket %d\n",stat,sock);
	294	else
	295	printk("m32r_pcc: Card is Inserted at socket %d(%.8x)\n",sock,stat);
	296	return 0;
	297	}
	298
4170a20f SM	299	static int add_pcc_socket(ulong base, int irq, ulong mapaddr,
4170a20f SM	300	unsigned int ioaddr)
1da177e4 LT	301	{
1da177e4 LT	302	pcc_socket_t *t = &socket[pcc_sockets];
4170a20f	303	int err;
1da177e4 LT	304
	305	/* add sockets */
	306	t->ioaddr = ioaddr;
	307	t->mapaddr = mapaddr;
	308	t->base = base;
	309	#ifdef CHAOS_PCC_DEBUG
	310	t->flags = MAP_16BIT;
	311	#else
	312	t->flags = 0;
	313	#endif
	314	if (is_alive(pcc_sockets))
	315	t->flags \|= IS_ALIVE;
	316
	317	/* add pcc */
	318	if (t->base > 0) {
	319	request_region(t->base, 0x20, "m32r-pcc");
	320	}
	321
	322	printk(KERN_INFO " %s ", pcc[pcc_sockets].name);
	323	printk("pcc at 0x%08lx\n", t->base);
	324
	325	/* Update socket interrupt information, capabilities */
	326	t->socket.features \|= (SS_CAP_PCCARD \| SS_CAP_STATIC_MAP);
	327	t->socket.map_size = M32R_PCC_MAPSIZE;
	328	t->socket.io_offset = ioaddr; /* use for io access offset */
	329	t->socket.irq_mask = 0;
	330	t->socket.pci_irq = 2 + pcc_sockets; /* XXX */
	331
4170a20f SM	332	err = request_irq(irq, pcc_interrupt, 0, "m32r-pcc", pcc_interrupt);
	333	if (err) {
	334	if (t->base > 0)
	335	release_region(t->base, 0x20);
	336	return err;
	337	}
1da177e4 LT	338
	339	pcc_sockets++;
	340
4170a20f	341	return 0;
1da177e4 LT	342	}
	343
	344
	345	/====================================================================/
	346
7d12e780	347	static irqreturn_t pcc_interrupt(int irq, void *dev)
1da177e4 LT	348	{
	349	int i, j, irc;
	350	u_int events, active;
	351	int handled = 0;
	352
c9f50ddd	353	pr_debug("m32r_pcc: pcc_interrupt(%d)\n", irq);
1da177e4 LT	354
	355	for (j = 0; j < 20; j++) {
	356	active = 0;
	357	for (i = 0; i < pcc_sockets; i++) {
	358	if ((socket[i].cs_irq != irq) &&
	359	(socket[i].socket.pci_irq != irq))
	360	continue;
	361	handled = 1;
	362	irc = pcc_get(i, PCIRC);
	363	irc >>=16;
c9f50ddd DB	364	pr_debug("m32r_pcc: interrupt: socket %d pcirc 0x%02x ",
c9f50ddd DB	365	i, irc);
1da177e4 LT	366	if (!irc)
	367	continue;
	368
	369	events = (irc) ? SS_DETECT : 0;
	370	events \|= (pcc_get(i,PCCR) & PCCR_PCEN) ? SS_READY : 0;
c9f50ddd	371	pr_debug("m32r_pcc: event 0x%02x\n", events);
1da177e4 LT	372
	373	if (events)
	374	pcmcia_parse_events(&socket[i].socket, events);
	375
	376	active \|= events;
	377	active = 0;
	378	}
	379	if (!active) break;
	380	}
	381	if (j == 20)
	382	printk(KERN_NOTICE "m32r-pcc: infinite loop in interrupt handler\n");
	383
c9f50ddd	384	pr_debug("m32r_pcc: interrupt done\n");
1da177e4 LT	385
	386	return IRQ_RETVAL(handled);
	387	} /* pcc_interrupt */
	388
	389	static void pcc_interrupt_wrapper(u_long data)
	390	{
9c8e7f5c	391	pcc_interrupt(0, NULL);
1da177e4 LT	392	init_timer(&poll_timer);
	393	poll_timer.expires = jiffies + poll_interval;
	394	add_timer(&poll_timer);
	395	}
	396
	397	/====================================================================/
	398
	399	static int _pcc_get_status(u_short sock, u_int *value)
	400	{
	401	u_int status;
	402
	403	status = pcc_get(sock,PCIRC);
	404	*value = ((status & PCIRC_CDIN1) && (status & PCIRC_CDIN2))
	405	? SS_DETECT : 0;
	406
	407	status = pcc_get(sock,PCCR);
	408
	409	#if 0
	410	*value \|= (status & PCCR_PCEN) ? SS_READY : 0;
	411	#else
	412	value \|= SS_READY; / XXX: always */
	413	#endif
	414
	415	status = pcc_get(sock,PCCSIGCR);
	416	*value \|= (status & PCCSIGCR_VEN) ? SS_POWERON : 0;
	417
c9f50ddd	418	pr_debug("m32r_pcc: GetStatus(%d) = %#4.4x\n", sock, *value);
1da177e4 LT	419	return 0;
	420	} /* _get_status */
	421
	422	/====================================================================/
	423
1da177e4 LT	424	static int _pcc_set_socket(u_short sock, socket_state_t *state)
	425	{
	426	u_long reg = 0;
	427
c9f50ddd	428	pr_debug("m32r_pcc: SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
1da177e4 LT	429	"io_irq %d, csc_mask %#2.2x)", sock, state->flags,
	430	state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
	431
	432	if (state->Vcc) {
	433	/*
	434	* 5V only
	435	*/
	436	if (state->Vcc == 50) {
	437	reg \|= PCCSIGCR_VEN;
	438	} else {
	439	return -EINVAL;
	440	}
	441	}
	442
	443	if (state->flags & SS_RESET) {
c9f50ddd	444	pr_debug("m32r_pcc: :RESET\n");
1da177e4 LT	445	reg \|= PCCSIGCR_CRST;
	446	}
	447	if (state->flags & SS_OUTPUT_ENA){
c9f50ddd	448	pr_debug("m32r_pcc: :OUTPUT_ENA\n");
1da177e4 LT	449	/* bit clear */
	450	} else {
	451	reg \|= PCCSIGCR_SEN;
	452	}
	453
	454	pcc_set(sock,PCCSIGCR,reg);
	455
1da177e4	456	if(state->flags & SS_IOCARD){
c9f50ddd	457	pr_debug("m32r_pcc: :IOCARD");
1da177e4 LT	458	}
1da177e4 LT	459	if (state->flags & SS_PWR_AUTO) {
c9f50ddd	460	pr_debug("m32r_pcc: :PWR_AUTO");
1da177e4 LT	461	}
1da177e4 LT	462	if (state->csc_mask & SS_DETECT)
c9f50ddd	463	pr_debug("m32r_pcc: :csc-SS_DETECT");
1da177e4 LT	464	if (state->flags & SS_IOCARD) {
1da177e4 LT	465	if (state->csc_mask & SS_STSCHG)
c9f50ddd	466	pr_debug("m32r_pcc: :STSCHG");
1da177e4 LT	467	} else {
1da177e4 LT	468	if (state->csc_mask & SS_BATDEAD)
c9f50ddd	469	pr_debug("m32r_pcc: :BATDEAD");
1da177e4	470	if (state->csc_mask & SS_BATWARN)
c9f50ddd	471	pr_debug("m32r_pcc: :BATWARN");
1da177e4	472	if (state->csc_mask & SS_READY)
c9f50ddd	473	pr_debug("m32r_pcc: :READY");
1da177e4	474	}
c9f50ddd	475	pr_debug("m32r_pcc: \n");
1da177e4 LT	476	return 0;
	477	} /* _set_socket */
	478
	479	/====================================================================/
	480
	481	static int _pcc_set_io_map(u_short sock, struct pccard_io_map *io)
	482	{
	483	u_char map;
	484
c9f50ddd	485	pr_debug("m32r_pcc: SetIOMap(%d, %d, %#2.2x, %d ns, "
5f784336 WS	486	"%#llx-%#llx)\n", sock, io->map, io->flags,
	487	io->speed, (unsigned long long)io->start,
	488	(unsigned long long)io->stop);
1da177e4 LT	489	map = io->map;
	490
	491	return 0;
	492	} /* _set_io_map */
	493
	494	/====================================================================/
	495
	496	static int _pcc_set_mem_map(u_short sock, struct pccard_mem_map *mem)
	497	{
	498
	499	u_char map = mem->map;
	500	u_long mode;
	501	u_long addr;
	502	pcc_socket_t *t = &socket[sock];
	503	#ifdef CHAOS_PCC_DEBUG
	504	#if 0
	505	pcc_as_t last = t->current_space;
	506	#endif
	507	#endif
	508
c9f50ddd	509	pr_debug("m32r_pcc: SetMemMap(%d, %d, %#2.2x, %d ns, "
5f784336 WS	510	"%#llx, %#x)\n", sock, map, mem->flags,
	511	mem->speed, (unsigned long long)mem->static_start,
	512	mem->card_start);
1da177e4 LT	513
	514	/*
	515	* sanity check
	516	*/
	517	if ((map > MAX_WIN) \|\| (mem->card_start > 0x3ffffff)){
	518	return -EINVAL;
	519	}
	520
	521	/*
	522	* de-activate
	523	*/
	524	if ((mem->flags & MAP_ACTIVE) == 0) {
	525	t->current_space = as_none;
	526	return 0;
	527	}
	528
	529	/*
	530	* Disable first
	531	*/
	532	pcc_set(sock, PCCR, 0);
	533
	534	/*
	535	* Set mode
	536	*/
	537	if (mem->flags & MAP_ATTRIB) {
	538	mode = PCMOD_AS_ATTRIB \| PCMOD_CBSZ;
	539	t->current_space = as_attr;
	540	} else {
	541	mode = 0; /* common memory */
	542	t->current_space = as_comm;
	543	}
	544	pcc_set(sock, PCMOD, mode);
	545
	546	/*
	547	* Set address
	548	*/
	549	addr = t->mapaddr + (mem->card_start & M32R_PCC_MAPMASK);
	550	pcc_set(sock, PCADR, addr);
	551
	552	mem->static_start = addr + mem->card_start;
	553
	554	/*
	555	* Enable again
	556	*/
	557	pcc_set(sock, PCCR, 1);
	558
	559	#ifdef CHAOS_PCC_DEBUG
	560	#if 0
	561	if (last != as_attr) {
	562	#else
	563	if (1) {
	564	#endif
	565	dummy_readbuf = (u_char )(addr + KSEG1);
	566	}
	567	#endif
	568
	569	return 0;
	570
	571	} /* _set_mem_map */
	572
	573	#if 0 /* driver model ordering issue */
	574	/*======================================================================
	575
	576	Routines for accessing socket information and register dumps via
577	/proc/bus/pccard/...
578
579	======================================================================*/
580
581	static ssize_t show_info(struct class_device class_dev, char buf)
582	{
583	pcc_socket_t *s = container_of(class_dev, struct pcc_socket,
584	socket.dev);
585
586	return sprintf(buf, "type: %s\nbase addr: 0x%08lx\n",
587	pcc[s->type].name, s->base);
588	}
589
590	static ssize_t show_exca(struct class_device class_dev, char buf)
591	{
592	/* FIXME */
593
594	return 0;
595	}
596
597	static CLASS_DEVICE_ATTR(info, S_IRUGO, show_info, NULL);
598	static CLASS_DEVICE_ATTR(exca, S_IRUGO, show_exca, NULL);
599	#endif
600
601	/====================================================================/
602
603	/* this is horribly ugly... proper locking needs to be done here at
604	* some time... */
605	#define LOCKED(x) do { \
606	int retval; \
607	unsigned long flags; \
608	spin_lock_irqsave(&pcc_lock, flags); \
609	retval = x; \
610	spin_unlock_irqrestore(&pcc_lock, flags); \
611	return retval; \
612	} while (0)
613
614
615	static int pcc_get_status(struct pcmcia_socket s, u_int value)
616	{
617	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;
618
619	if (socket[sock].flags & IS_ALIVE) {
620	*value = 0;
621	return -EINVAL;
622	}
623	LOCKED(_pcc_get_status(sock, value));
624	}
625
1da177e4 LT	626	static int pcc_set_socket(struct pcmcia_socket s, socket_state_t state)
	627	{
	628	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;
	629
	630	if (socket[sock].flags & IS_ALIVE)
	631	return -EINVAL;
	632
	633	LOCKED(_pcc_set_socket(sock, state));
	634	}
	635
	636	static int pcc_set_io_map(struct pcmcia_socket s, struct pccard_io_map io)
	637	{
	638	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;
	639
	640	if (socket[sock].flags & IS_ALIVE)
	641	return -EINVAL;
	642	LOCKED(_pcc_set_io_map(sock, io));
	643	}
	644
	645	static int pcc_set_mem_map(struct pcmcia_socket s, struct pccard_mem_map mem)
	646	{
	647	unsigned int sock = container_of(s, struct pcc_socket, socket)->number;
	648
	649	if (socket[sock].flags & IS_ALIVE)
	650	return -EINVAL;
	651	LOCKED(_pcc_set_mem_map(sock, mem));
	652	}
	653
	654	static int pcc_init(struct pcmcia_socket *s)
	655	{
c9f50ddd	656	pr_debug("m32r_pcc: init call\n");
1da177e4 LT	657	return 0;
	658	}
	659
	660	static struct pccard_operations pcc_operations = {
	661	.init = pcc_init,
	662	.get_status = pcc_get_status,
1da177e4 LT	663	.set_socket = pcc_set_socket,
	664	.set_io_map = pcc_set_io_map,
	665	.set_mem_map = pcc_set_mem_map,
	666	};
	667
	668	/====================================================================/
	669
7a192ec3 ML	670	static struct platform_driver pcc_driver = {
	671	.driver = {
	672	.name = "pcc",
7a192ec3	673	},
1da177e4 LT	674	};
	675
	676	static struct platform_device pcc_device = {
	677	.name = "pcc",
	678	.id = 0,
	679	};
	680
	681	/====================================================================/
	682
	683	static int __init init_m32r_pcc(void)
	684	{
	685	int i, ret;
	686
7a192ec3	687	ret = platform_driver_register(&pcc_driver);
1da177e4 LT	688	if (ret)
	689	return ret;
	690
	691	ret = platform_device_register(&pcc_device);
c795cf4f SM	692	if (ret)
c795cf4f SM	693	goto unreg_driv;
1da177e4 LT	694
	695	printk(KERN_INFO "m32r PCC probe:\n");
	696
	697	pcc_sockets = 0;
	698
3da82065 SM	699	ret = add_pcc_socket(M32R_PCC0_BASE, PCC0_IRQ, M32R_PCC0_MAPBASE,
	700	0x1000);
	701	if (ret)
	702	goto unreg_dev;
1da177e4 LT	703
1da177e4 LT	704	#ifdef CONFIG_M32RPCC_SLOT2
3da82065 SM	705	ret = add_pcc_socket(M32R_PCC1_BASE, PCC1_IRQ, M32R_PCC1_MAPBASE,
	706	0x2000);
	707	if (ret)
	708	goto unreg_dev;
1da177e4 LT	709	#endif
	710
	711	if (pcc_sockets == 0) {
	712	printk("socket is not found.\n");
c795cf4f SM	713	ret = -ENODEV;
c795cf4f SM	714	goto unreg_dev;
1da177e4 LT	715	}
	716
	717	/* Set up interrupt handler(s) */
	718
	719	for (i = 0 ; i < pcc_sockets ; i++) {
ccbe48f7	720	socket[i].socket.dev.parent = &pcc_device.dev;
1da177e4 LT	721	socket[i].socket.ops = &pcc_operations;
	722	socket[i].socket.resource_ops = &pccard_static_ops;
	723	socket[i].socket.owner = THIS_MODULE;
	724	socket[i].number = i;
	725	ret = pcmcia_register_socket(&socket[i].socket);
	726	if (!ret)
	727	socket[i].flags \|= IS_REGISTERED;
1da177e4 LT	728	}
	729
	730	/* Finally, schedule a polling interrupt */
	731	if (poll_interval != 0) {
	732	poll_timer.function = pcc_interrupt_wrapper;
	733	poll_timer.data = 0;
	734	init_timer(&poll_timer);
	735	poll_timer.expires = jiffies + poll_interval;
	736	add_timer(&poll_timer);
	737	}
	738
	739	return 0;
c795cf4f SM	740
	741	unreg_dev:
	742	platform_device_unregister(&pcc_device);
	743	unreg_driv:
	744	platform_driver_unregister(&pcc_driver);
	745	return ret;
1da177e4 LT	746	} /* init_m32r_pcc */
	747
	748	static void __exit exit_m32r_pcc(void)
	749	{
	750	int i;
	751
	752	for (i = 0; i < pcc_sockets; i++)
	753	if (socket[i].flags & IS_REGISTERED)
	754	pcmcia_unregister_socket(&socket[i].socket);
	755
	756	platform_device_unregister(&pcc_device);
	757	if (poll_interval != 0)
	758	del_timer_sync(&poll_timer);
	759
7a192ec3	760	platform_driver_unregister(&pcc_driver);
1da177e4 LT	761	} /* exit_m32r_pcc */
	762
	763	module_init(init_m32r_pcc);
	764	module_exit(exit_m32r_pcc);
	765	MODULE_LICENSE("Dual MPL/GPL");
	766	/====================================================================/