m8xx_pcmcia.c for v2.6 kernels
Pantelis Antoniou
panto at intracom.gr
Mon Oct 25 16:28:53 EST 2004
Marcelo Tosatti wrote:
>Hi fellows,
>
>
>I'm attaching a port of our internal m8xx_pcmcia.c (based
>on MontaVista 2.1's 2.4.17 kernel with many fixes) to v2.6.
>
>It works fine on our MPC8xx boxes, detects cards on the two slots,
>removal/insert event works.
>
>Would be nice if other people could give it a try.
>
>Also very interesting thing would be to merge other fixes
>done by MontaVista or others to this one driver and
>merge it upstream at some point.
>
>I volunteer to maintain it.
>
>
>
>
>------------------------------------------------------------------------
>
>/* -*- linux-c -*- */
>/*
> * m8xx_pcmcia.c - Linux PCMCIA socket driver for the mpc8xx series.
> *
> * (C) 1999-2000 Magnus Damm <damm at bitsmart.com>
> * (C) 2001-2002 Montavista Software, Inc.
> * <mlocke at mvista.com>
> * Support for two slots by Cyclades Corporation
> * <oliver.kurth at cyclades.de>
> *
> * v2.6 kernel port, further fixes by Cyclades Corporation
> * <marcelo.tosatti at cyclades.com>
> *
> * "The ExCA standard specifies that socket controllers should provide
> * two IO and five memory windows per socket, which can be independently
> * configured and positioned in the host address space and mapped to
> * arbitrary segments of card address space. " - David A Hinds. 1999
> *
> * This controller does _not_ meet the ExCA standard.
> *
> * m8xx pcmcia controller brief info:
> * + 8 windows (attrib, mem, i/o)
> * + up to two slots (SLOT_A and SLOT_B)
> * + inputpins, outputpins, event and mask registers.
> * - no offset register. sigh.
> *
> * Because of the lacking offset register we must map the whole card.
> * We assign each memory window PCMCIA_MEM_WIN_SIZE address space.
> * Make sure there is (PCMCIA_MEM_WIN_SIZE * PCMCIA_MEM_WIN_NO
> * * PCMCIA_SOCKETS_NO) bytes at PCMCIA_MEM_WIN_BASE.
> * The i/o windows are dynamically allocated at PCMCIA_IO_WIN_BASE.
> * They are maximum 64KByte each...
> */
>
>#include <linux/module.h>
>#include <linux/init.h>
>#include <linux/types.h>
>#include <linux/fcntl.h>
>#include <linux/string.h>
>
>#include <asm/io.h>
>#include <asm/bitops.h>
>#include <asm/segment.h>
>#include <asm/system.h>
>
>#include <linux/kernel.h>
>#include <linux/errno.h>
>#include <linux/sched.h>
>#include <linux/slab.h>
>#include <linux/timer.h>
>#include <linux/ioport.h>
>#include <linux/delay.h>
>
>#include <asm/mpc8xx.h>
>#include <asm/8xx_immap.h>
>#include <asm/irq.h>
>
>#include <pcmcia/version.h>
>#include <pcmcia/cs_types.h>
>#include <pcmcia/cs.h>
>#include <pcmcia/ss.h>
>
>#ifdef CONFIG_TSxK
>#include <asm/cpld.h>
>#endif
>
>#define PCMCIA_DEBUG 5
>#ifdef PCMCIA_DEBUG
>static int pc_debug = PCMCIA_DEBUG;
>MODULE_PARM(pc_debug, "i");
>#define DEBUG(n, args...) printk(KERN_DEBUG "m8xx_pcmcia: " args);
>#else
>#define DEBUG(n, args...)
>#endif
>
>#define PCMCIA_INFO(args...) printk(KERN_INFO "m8xx_pcmcia: "args)
>#define PCMCIA_ERROR(args...) printk(KERN_ERR "m8xx_pcmcia: "args)
>
>static const char *version = "Version 0.05-cyclades1, May 2003";
>MODULE_LICENSE("Dual MPL/GPL");
>
>#if !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B)
>
>/* The RPX series use SLOT_B */
>#if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
>#define CONFIG_PCMCIA_SLOT_B
>#define CONFIG_BD_IS_MHZ
>#endif
>
>/* The ADS board use SLOT_A */
>#ifdef CONFIG_ADS
>#define CONFIG_PCMCIA_SLOT_A
>#define CONFIG_BD_IS_MHZ
>#endif
>
>/* The FADS series are a mess */
>#ifdef CONFIG_FADS
>#if defined(CONFIG_MPC860T) || defined(CONFIG_MPC860) || defined(CONFIG_MPC821)
>#define CONFIG_PCMCIA_SLOT_A
>#else
>#define CONFIG_PCMCIA_SLOT_B
>#endif
>#endif
>
>/* Cyclades ACS uses both slots */
>#ifdef CONFIG_PRxK
>#define CONFIG_PCMCIA_SLOT_A
>#define CONFIG_PCMCIA_SLOT_B
>#endif
>
>#endif /* !defined(CONFIG_PCMCIA_SLOT_A) && !defined(CONFIG_PCMCIA_SLOT_B) */
>
>#if defined(CONFIG_PCMCIA_SLOT_A) && defined(CONFIG_PCMCIA_SLOT_B)
>
>#define PCMCIA_SOCKETS_NO 2
>/* We have only 8 windows, dualsocket support will be limited. */
>#define PCMCIA_MEM_WIN_NO 2
>#define PCMCIA_IO_WIN_NO 2
>#define PCMCIA_SLOT_MSG "SLOT_A and SLOT_B"
>
>#elif defined(CONFIG_PCMCIA_SLOT_A) || defined(CONFIG_PCMCIA_SLOT_B)
>
>#define PCMCIA_SOCKETS_NO 1
>/* full support for one slot */
>#define PCMCIA_MEM_WIN_NO 5
>#define PCMCIA_IO_WIN_NO 2
>
>/* define _slot_ to be able to optimize macros */
>
>#ifdef CONFIG_PCMCIA_SLOT_A
>#define _slot_ 0
>#define PCMCIA_SLOT_MSG "SLOT_A"
>#else
>#define _slot_ 1
>#define PCMCIA_SLOT_MSG "SLOT_B"
>#endif
>
>#else
>#error m8xx_pcmcia: Bad configuration!
>#endif
>
>/* ------------------------------------------------------------------------- */
>
>#define PCMCIA_MEM_WIN_BASE 0xe0000000 /* base address for memory window 0 */
>#define PCMCIA_MEM_WIN_SIZE 0x04000000 /* each memory window is 64 MByte */
>#define PCMCIA_IO_WIN_BASE _IO_BASE /* base address for io window 0 */
>
>#define PCMCIA_SCHLVL PCMCIA_INTERRUPT /* Status Change Interrupt Level */
>
>/* ------------------------------------------------------------------------- */
>
>//#if (LINUX_VERSION_CODE >= VERSION(2,4,0))
>#if 1
>/* 2.4.x has this always in HZ */
>#define M8XX_BUSFREQ ((((bd_t *)&(__res))->bi_busfreq))
>#else /* 2.2.x */
>#ifdef CONFIG_BD_IS_MHZ
>#define M8XX_BUSFREQ ((mpc8xx_bdinfo->bi_busfreq) * 1000000)
>#else
>#define M8XX_BUSFREQ (mpc8xx_bdinfo->bi_busfreq)
>#endif
>#endif
>
>static int pcmcia_schlvl = PCMCIA_SCHLVL;
>
>spinlock_t events_lock = SPIN_LOCK_UNLOCKED;
>
>/* ------------------------------------------------------------------------- */
>
>#define PCMCIA_SOCKET_KEY_5V 1
>#define PCMCIA_SOCKET_KEY_LV 2
>
>/* look up table for pgcrx registers */
>static u_int *m8xx_pgcrx[2] = {
> &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pgcra,
> &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pgcrb
>};
>
>/*
> * This structure is used to address each window in the PCMCIA controller.
> *
> * Keep in mind that we assume that pcmcia_win_t[n+1] is mapped directly
> * after pcmcia_win_t[n]...
> */
>
>typedef struct {
> uint br;
> uint or;
>} pcmcia_win_t;
>
>/*
> * For some reason the hardware guys decided to make both slots share
> * some registers.
> *
> * Could someone invent object oriented hardware ?
> *
> * The macros are used to get the right bit from the registers.
> * SLOT_A : slot = 0
> * SLOT_B : slot = 1
> */
>
>#define M8XX_PCMCIA_VS1(slot) (0x80000000 >> (slot << 4))
>#define M8XX_PCMCIA_VS2(slot) (0x40000000 >> (slot << 4))
>#define M8XX_PCMCIA_VS_MASK(slot) (0xc0000000 >> (slot << 4))
>#define M8XX_PCMCIA_VS_SHIFT(slot) (30 - (slot << 4))
>
>#define M8XX_PCMCIA_WP(slot) (0x20000000 >> (slot << 4))
>#define M8XX_PCMCIA_CD2(slot) (0x10000000 >> (slot << 4))
>#define M8XX_PCMCIA_CD1(slot) (0x08000000 >> (slot << 4))
>#define M8XX_PCMCIA_BVD2(slot) (0x04000000 >> (slot << 4))
>#define M8XX_PCMCIA_BVD1(slot) (0x02000000 >> (slot << 4))
>#define M8XX_PCMCIA_RDY(slot) (0x01000000 >> (slot << 4))
>#define M8XX_PCMCIA_RDY_L(slot) (0x00800000 >> (slot << 4))
>#define M8XX_PCMCIA_RDY_H(slot) (0x00400000 >> (slot << 4))
>#define M8XX_PCMCIA_RDY_R(slot) (0x00200000 >> (slot << 4))
>#define M8XX_PCMCIA_RDY_F(slot) (0x00100000 >> (slot << 4))
>#define M8XX_PCMCIA_MASK(slot) (0xFFFF0000 >> (slot << 4))
>
>#define M8XX_PCMCIA_POR_VALID 0x00000001
>#define M8XX_PCMCIA_POR_WRPROT 0x00000002
>#define M8XX_PCMCIA_POR_ATTRMEM 0x00000010
>#define M8XX_PCMCIA_POR_IO 0x00000018
>#define M8XX_PCMCIA_POR_16BIT 0x00000040
>
>#define M8XX_PGCRX(slot) (*m8xx_pgcrx[slot])
>
>#define M8XX_PGCRX_CXOE 0x00000080
>#define M8XX_PGCRX_CXRESET 0x00000040
>
>/* we keep one lookup table per socket to check flags */
>
>#define PCMCIA_EVENTS_MAX 5 /* 4 max at a time + termination */
>
>typedef struct {
> u_int regbit;
> u_int eventbit;
>} event_table_t;
>
>typedef struct socket_info_t {
> void (*handler)(void *info, u_int events);
> void *info;
>
> u_int slot;
>
> socket_state_t state;
> struct pccard_mem_map mem_win[PCMCIA_MEM_WIN_NO];
> struct pccard_io_map io_win[PCMCIA_IO_WIN_NO];
> event_table_t events[PCMCIA_EVENTS_MAX];
> struct pcmcia_socket socket;
>} socket_info_t;
>
>static socket_info_t socket[PCMCIA_SOCKETS_NO];
>
>/*
> * Search this table to see if the windowsize is
> * supported...
> */
>
>#define M8XX_SIZES_NO 32
>
>static const u_int m8xx_size_to_gray[M8XX_SIZES_NO] =
>{
> 0x00000001, 0x00000002, 0x00000008, 0x00000004,
> 0x00000080, 0x00000040, 0x00000010, 0x00000020,
> 0x00008000, 0x00004000, 0x00001000, 0x00002000,
> 0x00000100, 0x00000200, 0x00000800, 0x00000400,
>
> 0x0fffffff, 0xffffffff, 0xffffffff, 0xffffffff,
> 0x01000000, 0x02000000, 0xffffffff, 0x04000000,
> 0x00010000, 0x00020000, 0x00080000, 0x00040000,
> 0x00800000, 0x00400000, 0x00100000, 0x00200000
>};
>
>/* ------------------------------------------------------------------------- */
>
>static void m8xx_interrupt(int irq, void *dev, struct pt_regs *regs);
>
>#define PCMCIA_BMT_LIMIT (15*4) /* Bus Monitor Timeout value */
>
>/* ------------------------------------------------------------------------- */
>/* board specific stuff: */
>/* voltage_set(), hardware_enable() and hardware_disable() */
>/* ------------------------------------------------------------------------- */
>/* RPX Boards from Embedded Planet */
>
>#if defined(CONFIG_RPXCLASSIC) || defined(CONFIG_RPXLITE)
>
>/* The RPX boards seems to have it's bus monitor timeout set to 6*8 clocks.
> * SYPCR is write once only, therefore must the slowest memory be faster
> * than the bus monitor or we will get a machine check due to the bus timeout.
> */
>
>#define PCMCIA_BOARD_MSG "RPX CLASSIC or RPX LITE"
>
>#undef PCMCIA_BMT_LIMIT
>#define PCMCIA_BMT_LIMIT (6*8)
>
>static int voltage_set(int slot, int vcc, int vpp)
>{
> u_int reg = 0;
>
> switch(vcc) {
> case 0: break;
> case 33: reg |= BCSR1_PCVCTL4; break;
> case 50: reg |= BCSR1_PCVCTL5; break;
> default: return 1;
> }
>
> switch(vpp) {
> case 0: break;
> case 33:
> case 50:
> if(vcc == vpp)
> reg |= BCSR1_PCVCTL6;
> else
> return 1;
> break;
> case 120:
> reg |= BCSR1_PCVCTL7;
> default: return 1;
> }
>
> if(!((vcc == 50) || (vcc == 0)))
> return 1;
>
> /* first, turn off all power */
>
> *((uint *)RPX_CSR_ADDR) &= ~(BCSR1_PCVCTL4 | BCSR1_PCVCTL5
> | BCSR1_PCVCTL6 | BCSR1_PCVCTL7);
>
> /* enable new powersettings */
>
> *((uint *)RPX_CSR_ADDR) |= reg;
>
> return 0;
>}
>
>#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
>#define hardware_enable(_slot_) /* No hardware to enable */
>#define hardware_disable(_slot_) /* No hardware to disable */
>
>#endif /* CONFIG_RPXCLASSIC */
>
>/* ------------------------------------------------------------------------- */
>/* FADS Boards from Motorola */
>
>#if defined(CONFIG_FADS)
>
>#define PCMCIA_BOARD_MSG "FADS"
>
>static int voltage_set(int slot, int vcc, int vpp)
>{
> uint reg = 0;
>
> switch(vcc) {
> case 0: break;
> case 33: reg |= BCSR1_PCCVCC0; break;
> case 50: reg |= BCSR1_PCCVCC1; break;
> default: return 1;
> }
>
> switch(vpp) {
> case 0: break;
> case 33:
> case 50:
> if(vcc == vpp)
> reg |= BCSR1_PCCVPP1;
> else
> return 1;
> break;
> case 120:
> if ((vcc == 33) || (vcc == 50))
> reg |= BCSR1_PCCVPP0;
> else
> return 1;
> default: return 1;
> }
>
> /* first, turn off all power */
> *((uint *)BCSR1) &= ~(BCSR1_PCCVCC_MASK | BCSR1_PCCVPP_MASK);
>
> /* enable new powersettings */
> *((uint *)BCSR1) |= reg;
>
> return 0;
>}
>
>#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
>
>static void hardware_enable(int slot)
>{
> *((uint *)BCSR1) &= ~BCSR1_PCCEN;
>}
>
>static void hardware_disable(int slot)
>{
> *((uint *)BCSR1) |= BCSR1_PCCEN;
>}
>
>#endif
>
>/* ------------------------------------------------------------------------- */
>/* Motorola MBX860 */
>
>#if defined(CONFIG_MBX)
>
>#define PCMCIA_BOARD_MSG "MBX"
>
>static int voltage_set(int slot, int vcc, int vpp)
>{
> unsigned char reg = 0;
>
> switch(vcc) {
> case 0: break;
> case 33: reg |= CSR2_VCC_33; break;
> case 50: reg |= CSR2_VCC_50; break;
> default: return 1;
> }
>
> switch(vpp) {
> case 0: break;
> case 33:
> case 50:
> if(vcc == vpp)
> reg |= CSR2_VPP_VCC;
> else
> return 1;
> break;
> case 120:
> if ((vcc == 33) || (vcc == 50))
> reg |= CSR2_VPP_12;
> else
> return 1;
> default: return 1;
> }
>
> /* first, turn off all power */
> *((unsigned char *)MBX_CSR2_ADDR) &= ~(CSR2_VCC_MASK | CSR2_VPP_MASK);
>
> /* enable new powersettings */
> *((unsigned char *)MBX_CSR2_ADDR) |= reg;
>
> return 0;
>}
>
>#define socket_get(_slot_) PCMCIA_SOCKET_KEY_5V
>#define hardware_enable(_slot_) /* No hardware to enable */
>#define hardware_disable(_slot_) /* No hardware to disable */
>
>#endif /* CONFIG_MBX */
>
>/* ------------------------------------------------------------------------- */
>
>#if defined(CONFIG_PRxK)
>
>//extern volatile cpld_regs *cpld;
>extern volatile fpga_pc_regs *fpga_pc;
>
>#define PCMCIA_BOARD_MSG "MPC855T"
>
>static int voltage_set(int slot, int vcc, int vpp)
>{
> unsigned char reg = 0;
> unsigned char regread;
> cpld_regs *ccpld = get_cpld();
>
> printk(KERN_ERR "cpld:%x vcc:%x vpp:%x\n", ccpld,vcc,vpp);
>
> switch(vcc) {
> case 0: break;
> case 33: reg |= PCMCIA_VCC_33; break;
> case 50: reg |= PCMCIA_VCC_50; break;
> default: return 1;
> }
>
> switch(vpp) {
> case 0: break;
> case 33:
> case 50:
> if(vcc == vpp)
> reg |= PCMCIA_VPP_VCC;
> else
> return 1;
> break;
> case 120:
> if ((vcc == 33) || (vcc == 50))
> reg |= PCMCIA_VPP_12;
> else
> return 1;
> default: return 1;
> }
>
> printk(KERN_ERR "voltage_set(%d)\n", slot);
>
> reg = reg >> (slot << 2);
> regread = ccpld->fpga_pc_ctl;
> if (reg != (regread & ((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2)))) {
> /* enable new powersettings */
> regread = regread & ~((PCMCIA_VCC_MASK | PCMCIA_VPP_MASK) >> (slot << 2));
> ccpld->fpga_pc_ctl = reg | regread;
> printk(KERN_ERR "enabling powersetting(%d)\n", slot);
> mdelay(100);
> }
>
> return 0;
>}
>
>#define socket_get(_slot_) PCMCIA_SOCKET_KEY_LV
>#define hardware_enable(_slot_) /* No hardware to enable */
>#define hardware_disable(_slot_) /* No hardware to disable */
>
>#endif /* CONFIG_PRxK */
>
>/* ------------------------------------------------------------------------- */
>
>static void m8xx_shutdown(void)
>{
> u_int m, i;
> pcmcia_win_t *w;
>
> for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
> w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
>
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr =
> M8XX_PCMCIA_MASK(i);
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per
> &= ~M8XX_PCMCIA_MASK(i);
>
> /* turn off interrupt and disable CxOE */
> M8XX_PGCRX(i) = M8XX_PGCRX_CXOE;
>
> /* turn off memory windows */
> for(m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
> w->or = 0; /* set to not valid */
> w++;
> }
>
> /* turn off voltage */
> voltage_set(i, 0, 0);
>
> /* disable external hardware */
> hardware_disable(i);
> }
>
> free_irq(pcmcia_schlvl, NULL);
>}
>
>/* ------------------------------------------------------------------------- */
>
>/* ------------------------------------------------------------------------- */
>
>/* copied from tcic.c */
>
>static int m8xx_drv_suspend(struct device *dev, u32 state, u32 level)
>{
> int ret = 0;
> if (level == SUSPEND_SAVE_STATE)
> ret = pcmcia_socket_dev_suspend(dev, state);
> return ret;
>}
>
>static int m8xx_drv_resume(struct device *dev, u32 level)
>{
> int ret = 0;
> if (level == RESUME_RESTORE_STATE)
> ret = pcmcia_socket_dev_resume(dev);
> return ret;
>}
>
>static struct device_driver m8xx_driver = {
> .name = "m8xx-pcmcia",
> .bus = &platform_bus_type,
> .suspend = m8xx_drv_suspend,
> .resume = m8xx_drv_resume,
>};
>
>static struct platform_device m8xx_device = {
> .name = "m8xx-pcmcia",
> .id = 0,
>};
>
>static u_int pending_events[PCMCIA_SOCKETS_NO];
>static spinlock_t pending_event_lock = SPIN_LOCK_UNLOCKED;
>
>static void m8xx_pcmcia_bh(void *dummy)
>{
> u_int events, per;
> int i;
>
> for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
> spin_lock_irq(&pending_event_lock);
> events = pending_events[i];
> pending_events[i] = 0;
> spin_unlock_irq(&pending_event_lock);
> /*
> SS_DETECT events need a small delay here. The reason for this is that
> the "is there a card" electronics need time to see the card after the
> "we have a card coming in" electronics have seen it.
> */
> if (events & SS_DETECT) {
> mdelay(4);
>
> /*
> * disable the IRQ to avoid possible bad interrutps
> * on card removal. On insertion "state.io_irq"
> * is always zero, so its OK to "disable_irq(0)"
> * since there are no interrupt registered on 0.
> * This fixes IDE CompactFlash and harddisk
> * on the ACS. - marcelo
> *
> */
> if (socket[i].state.io_irq)
> disable_irq(socket[i].state.io_irq);
> }
> if (socket[i].handler)
> socket[i].handler(socket[i].info, events);
> }
>}
>
>//static struct tq_struct m8xx_pcmcia_task = {
>// routine: m8xx_pcmcia_bh
>//};
>
>static struct work_struct m8xx_pcmcia_task = {
> func: m8xx_pcmcia_bh
>};
>
>static void m8xx_interrupt(int irq, void *dev, struct pt_regs *regs)
>{
> socket_info_t *s;
> event_table_t *e;
> u_int i, events, pscr, pipr, per;
>
> DEBUG(3,"Interrupt!\n");
> /* get interrupt sources */
>
> pscr = ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr;
> pipr = ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr;
> per = ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per;
>
> printk(KERN_ERR "PCMCIA PIPR:%x\n", pipr);
>
> for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
> s = &socket[i];
> printk(KERN_ERR "checking socket %d\n", i);
> if(s->handler) {
>
> printk(KERN_ERR "%d has handler\n", i);
>
> e = &s->events[0];
> events = 0;
>
> while(e->regbit) {
> if(pscr & e->regbit)
> events |= e->eventbit;
>
> e++;
> }
>
> /*
> * report only if both card detect signals are the same
> * not too nice done,
> * we depend on that CD2 is the bit to the left of CD1...
> */
>
> if(events & SS_DETECT)
> if(
> ((pipr & M8XX_PCMCIA_CD2(i)) >> 1) ^
> (pipr & M8XX_PCMCIA_CD1(i))
> )
> {
> events &= ~SS_DETECT;
> }
>
>#define PCMCIA_GLITCHY_CD
>/*
> * PCMCIA_GLITCHY_CD is enabled on the ACS because it avoids
> * bad interrupts on "IDE" PCMCIA cards, and possibly others.
> * These interrupts can be generated by the PCMCIA controller
> * until the card is correctly settled down eletrically.
> * - marcelo
> */
>#ifdef PCMCIA_GLITCHY_CD
>
> /*
> * I've experienced CD problems with my ADS board.
> * We make an extra check to see if there was a
> * real change of Card detection.
> */
>
> if((events & SS_DETECT) &&
> ((pipr &
> (M8XX_PCMCIA_CD2(i) | M8XX_PCMCIA_CD1(i))) == 0) &&
> (s->state.Vcc | s->state.Vpp)) {
> events &= ~SS_DETECT;
> /*printk( "CD glitch workaround - CD = 0x%08x!\n",
> (pipr & (M8XX_PCMCIA_CD2(i)
> | M8XX_PCMCIA_CD1(i))));*/
> }
>#endif
>
> /* call the handler */
>
> DEBUG(3,
> "slot %u: events = 0x%02x, pscr = 0x%08x, "
> "pipr = 0x%08x\n",
> i, events, pscr, pipr);
>
> if(events) {
> spin_lock(&pending_event_lock);
> pending_events[i] |= events;
> spin_unlock(&pending_event_lock);
> /*
> * Turn off RDY_L bits in the PER mask on
> * CD interrupt receival.
> *
> * They can generate bad interrupts on the
> * ACS4,8,16,32. - marcelo
> */
> per &= ~M8XX_PCMCIA_RDY_L(0);
> per &= ~M8XX_PCMCIA_RDY_L(1);
>
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per = per;
>
> // schedule_work(&m8xx_pcmcia_task);
> if (events)
> pcmcia_parse_events(&socket[i].socket, events);
> }
>
> }
>
> }
>
> /* clear the interrupt sources */
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr = pscr;
>
> DEBUG(3,"Interrupt done.\n");
>}
>
>/* ------------------------------------------------------------------------- */
>
>static u_int m8xx_get_graycode(u_int size)
>{
> u_int k;
>
> for(k = 0; k < M8XX_SIZES_NO; k++)
> if(m8xx_size_to_gray[k] == size)
> break;
>
> if((k == M8XX_SIZES_NO) || (m8xx_size_to_gray[k] == -1))
> k = -1;
>
> return k;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static u_int m8xx_get_speed(u_int ns, u_int is_io)
>{
> u_int reg, clocks, psst, psl, psht;
>
> if(!ns) {
>
> /*
> * We get called with IO maps setup to 0ns
> * if not specified by the user.
> * They should be 255ns.
> */
>
> if(is_io)
> ns = 255;
> else
> ns = 100; /* fast memory if 0 */
> }
>
> /*
> * In PSST, PSL, PSHT fields we tell the controller
> * timing parameters in CLKOUT clock cycles.
> * CLKOUT is the same as GCLK2_50.
> */
>
>/* how we want to adjust the timing - in percent */
>
>#define ADJ 180 /* 80 % longer accesstime - to be sure */
>
> clocks = ((M8XX_BUSFREQ / 1000) * ns) / 1000;
> clocks = (clocks * ADJ) / (100*1000);
> if(clocks >= PCMCIA_BMT_LIMIT) {
> printk( "Max access time limit reached\n");
> clocks = PCMCIA_BMT_LIMIT-1;
> }
>
> psst = clocks / 7; /* setup time */
> psht = clocks / 7; /* hold time */
> psl = (clocks * 5) / 7; /* strobe length */
>
> psst += clocks - (psst + psht + psl);
>
> reg = psst << 12;
> reg |= psl << 7;
> reg |= psht << 16;
>
> return reg;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_register_callback(struct pcmcia_socket *sock,
> void (*handler)(void *, unsigned int), void * info)
>{
> int sock = container_of(sock, struct socket_info_t, socket)->slot;
>
> socket[sock].handler = handler;
> socket[sock].info = info;
> if (handler == NULL) {
> MOD_DEC_USE_COUNT;
> }
> else {
> MOD_INC_USE_COUNT;
> }
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_get_status(struct pcmcia_socket *sock, u_int *value)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
> socket_info_t *s = &socket[lsock];
> u_int pipr, reg;
>
>
> pipr = ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pipr;
>
> printk(KERN_ERR "%s: PIPR:%x\n", __FUNCTION__, pipr);
>
> *value = ((pipr & (M8XX_PCMCIA_CD1(lsock)
> | M8XX_PCMCIA_CD2(lsock))) == 0) ? SS_DETECT : 0;
> *value |= (pipr & M8XX_PCMCIA_WP(lsock)) ? SS_WRPROT : 0;
>
> if (s->state.flags & SS_IOCARD)
> *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_STSCHG : 0;
> else {
> *value |= (pipr & M8XX_PCMCIA_RDY(lsock)) ? SS_READY : 0;
> *value |= (pipr & M8XX_PCMCIA_BVD1(lsock)) ? SS_BATDEAD : 0;
> *value |= (pipr & M8XX_PCMCIA_BVD2(lsock)) ? SS_BATWARN : 0;
> }
>
> if (s->state.Vcc | s->state.Vpp)
> *value |= SS_POWERON;
>
> /*
> * Voltage detection:
> * This driver only supports 16-Bit pc-cards.
> * Cardbus is not handled here.
> *
> * To determine what voltage to use we must read the VS1 and VS2 pin.
> * Depending on what socket type is present,
> * different combinations mean different things.
> *
> * Card Key Socket Key VS1 VS2 Card Vcc for CIS parse
> *
> * 5V 5V, LV* NC NC 5V only 5V (if available)
> *
> * 5V 5V, LV* GND NC 5 or 3.3V as low as possible
> *
> * 5V 5V, LV* GND GND 5, 3.3, x.xV as low as possible
> *
> * LV* 5V - - shall not fit into socket
> *
> * LV* LV* GND NC 3.3V only 3.3V
> *
> * LV* LV* NC GND x.xV x.xV (if avail.)
> *
> * LV* LV* GND GND 3.3 or x.xV as low as possible
> *
> * *LV means Low Voltage
> *
> *
> * That gives us the following table:
> *
> * Socket VS1 VS2 Voltage
> *
> * 5V NC NC 5V
> * 5V NC GND none (should not be possible)
> * 5V GND NC >= 3.3V
> * 5V GND GND >= x.xV
> *
> * LV NC NC 5V (if available)
> * LV NC GND x.xV (if available)
> * LV GND NC 3.3V
> * LV GND GND >= x.xV
> *
> * So, how do I determine if I have a 5V or a LV
> * socket on my board? Look at the socket!
> *
> *
> * Socket with 5V key:
> * ++--------------------------------------------+
> * || |
> * || ||
> * || ||
> * | |
> * +---------------------------------------------+
> *
> * Socket with LV key:
> * ++--------------------------------------------+
> * || |
> * | ||
> * | ||
> * | |
> * +---------------------------------------------+
> *
> *
> * With other words - LV only cards does not fit
> * into the 5V socket!
> */
>
> /* read out VS1 and VS2 */
>
> reg = (pipr & M8XX_PCMCIA_VS_MASK(lsock))
> >> M8XX_PCMCIA_VS_SHIFT(lsock);
>
> if(socket_get(lsock) == PCMCIA_SOCKET_KEY_LV) {
> switch(reg) {
> case 1: *value |= SS_3VCARD; break; /* GND, NC - 3.3V only */
> case 2: *value |= SS_XVCARD; break; /* NC. GND - x.xV only */
> };
> }
>
> DEBUG(3,"GetStatus(%d) = %#2.2x\n", lsock, *value);
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>#if 0
>static int m8xx_inquire_socket(unsigned int lsock, socket_cap_t *cap)
>{
> /* only 16-bit cards, memory windows must be size-aligned: */
> cap->features = SS_CAP_PCCARD | SS_CAP_MEM_ALIGN | SS_CAP_STATIC_MAP;
> cap->irq_mask = 0x000; /* SIU_LEVEL 7 -> 0 */
> cap->map_size = 0x1000; /* 4K minimum window size */
> cap->io_offset = 0;
> cap->pci_irq = lsock ? 7 : 9; /* RQ9 for 1st slot, IRQ7 for 2nd */
> cap->cb_dev = NULL; /* No PCI or CardBus support */
> cap->bus = NULL;
>
> return 0;
>}
>#endif
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_get_socket(struct pcmcia_socket *sock, socket_state_t *state)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
> *state = socket[lsock].state; /* copy the whole structure */
>
> DEBUG(3,"GetSocket(%d) = flags %#3.3x, Vcc %d, Vpp %d, "
> "io_irq %d, csc_mask %#2.2x\n", lsock, state->flags,
> state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_set_socket(struct pcmcia_socket *sock, socket_state_t *state)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
> socket_info_t *s = &socket[lsock];
> event_table_t *e;
> u_int reg;
> u_long flags;
>
> DEBUG(3, "SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
> "io_irq %d, csc_mask %#2.2x)\n", lsock, state->flags,
> state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
>
> /* code by Fanny, solves trouble with a modem card,
> which causes too many interrupts (oku) */
> /* SS_DEBOUNCED handling copied from yenta driver */
>#if 0
> if (state->flags & SS_DEBOUNCED) {
> /* The insertion debounce period has ended.
> Clear any pending insertion events */
> spin_lock(&pending_event_lock);
> pending_events[lsock] &= ~SS_DETECT;
> spin_unlock(&pending_event_lock);
> state->flags &= ~SS_DEBOUNCED; /* SS_DEBOUNCED is oneshot */
> }
>#endif
>
> /* First, set voltage - bail out if invalid */
> if(voltage_set(lsock, state->Vcc, state->Vpp))
> return -EINVAL;
>
> /* Take care of reset... */
> if(state->flags & SS_RESET)
> M8XX_PGCRX(lsock) |= M8XX_PGCRX_CXRESET; /* active high */
> else
> M8XX_PGCRX(lsock) &= ~M8XX_PGCRX_CXRESET;
>
> /* ... and output enable. */
>
> /* The CxOE signal is connected to a 74541 on the ADS.
> I guess most other boards used the ADS as a reference.
> I tried to control the CxOE signal with SS_OUTPUT_ENA,
> but the reset signal seems connected via the 541.
> If the CxOE is left high are some signals tristated and
> no pullups are present -> the cards act wierd.
> So right now the buffers are enabled if the power is on. */
>
> if(state->Vcc || state->Vpp)
> M8XX_PGCRX(lsock) &= ~M8XX_PGCRX_CXOE; /* active low */
> else
> M8XX_PGCRX(lsock) |= M8XX_PGCRX_CXOE;
>
> /*
> * We'd better turn off interrupts before
> * we mess with the events-table..
> */
>
> spin_lock_irqsave(&events_lock, flags);
>
> /*
> * Play around with the interrupt mask to be able to
> * give the events the generic pcmcia driver wants us to.
> */
>
> e = &s->events[0];
> reg = 0;
>
> if(state->csc_mask & SS_DETECT) {
> e->eventbit = SS_DETECT;
> reg |= e->regbit = (M8XX_PCMCIA_CD2(lsock)
> | M8XX_PCMCIA_CD1(lsock));
> e++;
> }
> if(state->flags & SS_IOCARD) {
> /*
> * I/O card
> */
> if(state->csc_mask & SS_STSCHG) {
> e->eventbit = SS_STSCHG;
> reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
> e++;
> }
> /*
> * If io_irq is non-zero we should enable irq.
> */
> if(state->io_irq) {
> M8XX_PGCRX(lsock) |=
> mk_int_int_mask(state->io_irq) << 24;
> /*
> * Strange thing here:
> * The manual does not tell us which interrupt
> * the sources generate.
> * Anyhow, I found out that RDY_L generates IREQLVL.
> *
> * We use level triggerd interrupts, and they don't
> * have to be cleared in PSCR in the interrupt handler.
> */
> reg |= M8XX_PCMCIA_RDY_L(lsock);
> }
> else
> M8XX_PGCRX(lsock) &= 0x00ffffff;
> }
> else {
> /*
> * Memory card
> */
> if(state->csc_mask & SS_BATDEAD) {
> e->eventbit = SS_BATDEAD;
> reg |= e->regbit = M8XX_PCMCIA_BVD1(lsock);
> e++;
> }
> if(state->csc_mask & SS_BATWARN) {
> e->eventbit = SS_BATWARN;
> reg |= e->regbit = M8XX_PCMCIA_BVD2(lsock);
> e++;
> }
> /* What should I trigger on - low/high,raise,fall? */
> if(state->csc_mask & SS_READY) {
> e->eventbit = SS_READY;
> reg |= e->regbit = 0; //??
> e++;
> }
> }
>
> e->regbit = 0; /* terminate list */
>
> /*
> * Clear the status changed .
> * Port A and Port B share the same port.
> * Writing ones will clear the bits.
> */
>
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr = reg;
>
> /*
> * Write the mask.
> * Port A and Port B share the same port.
> * Need for read-modify-write.
> * Ones will enable the interrupt.
> */
>
> /*
> reg |= ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per
> & M8XX_PCMCIA_MASK(lsock);
> */
>
> reg |= ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per
> & ( M8XX_PCMCIA_MASK(0) | M8XX_PCMCIA_MASK(1) );
>
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per = reg;
>
> spin_unlock_irqrestore(&events_lock, flags);
>
> /* copy the struct and modify the copy */
>
> s->state = *state;
>
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_get_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
>
> if(io->map >= PCMCIA_IO_WIN_NO)
> return -EINVAL;
>
> *io = socket[lsock].io_win[io->map]; /* copy the struct */
>
> DEBUG(3,"GetIOMap(%d, %d) = %#2.2x, %d ns, "
> "%#4.4x-%#4.4x\n", lsock, io->map, io->flags,
> io->speed, io->start, io->stop);
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_set_io_map(struct pcmcia_socket *sock, struct pccard_io_map *io)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
>
> socket_info_t *s = &socket[lsock];
> pcmcia_win_t *w;
> u_int reg, winnr;
>
>
>#define M8XX_SIZE (io->stop - io->start + 1)
>#define M8XX_BASE (PCMCIA_IO_WIN_BASE + io->start)
>
> DEBUG(3, "SetIOMap(%d, %d, %#2.2x, %d ns, "
> "%#4.4x-%#4.4x)\n", lsock, io->map, io->flags,
> io->speed, io->start, io->stop);
>
> if ((io->map >= PCMCIA_IO_WIN_NO) || (io->start > 0xffff)
> || (io->stop > 0xffff) || (io->stop < io->start))
> return -EINVAL;
>
> if((reg = m8xx_get_graycode(M8XX_SIZE)) == -1)
> return -EINVAL;
>
> if(io->flags & MAP_ACTIVE) {
>
> DEBUG(3, "io->flags & MAP_ACTIVE\n");
>
> winnr = (PCMCIA_MEM_WIN_NO * PCMCIA_SOCKETS_NO)
> + (lsock * PCMCIA_IO_WIN_NO) + io->map;
>
> /* setup registers */
>
> w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
> w += winnr;
>
> w->or = 0; /* turn off window first */
> w->br = M8XX_BASE;
>
> reg <<= 27;
> reg |= M8XX_PCMCIA_POR_IO |(lsock << 2);
>
> reg |= m8xx_get_speed(io->speed, 1);
>
> if(io->flags & MAP_WRPROT)
> reg |= M8XX_PCMCIA_POR_WRPROT;
>
>// if(io->flags & (MAP_16BIT | MAP_AUTOSZ))
> if(io->flags & MAP_16BIT)
> reg |= M8XX_PCMCIA_POR_16BIT;
>
> if(io->flags & MAP_ACTIVE)
> reg |= M8XX_PCMCIA_POR_VALID;
>
> w->or = reg;
>
> DEBUG(3,"Socket %u: Mapped io window %u at %#8.8x, "
> "OR = %#8.8x.\n", lsock, io->map, w->br, w->or);
> }
>
>
> /* copy the struct and modify the copy */
>
> s->io_win[io->map] = *io;
> s->io_win[io->map].flags &= (MAP_WRPROT
> | MAP_16BIT
> | MAP_ACTIVE);
> DEBUG(3, "SetIOMap exit\n");
>
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_get_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *mem)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
>
> if(mem->map >= PCMCIA_MEM_WIN_NO)
> return -EINVAL;
>
> *mem = socket[lsock].mem_win[mem->map]; /* copy the struct */
>
> DEBUG(3, "GetMemMap(%d, %d) = %#2.2x, %d ns, "
> "%#5.5lx-%#5.5lx, %#5.5x\n", lsock, mem->map, mem->flags,
> mem->speed, mem->sys_start, mem->sys_stop, mem->card_start);
> return 0;
>}
>
>/* ------------------------------------------------------------------------- */
>
>static int m8xx_set_mem_map(struct pcmcia_socket *sock, struct pccard_mem_map *mem)
>{
> int lsock = container_of(sock, struct socket_info_t, socket)->slot;
> socket_info_t *s = &socket[lsock];
> pcmcia_win_t *w;
> struct pccard_mem_map *old;
> u_int reg, winnr;
>
> DEBUG(3, "SetMemMap(%d, %d, %#2.2x, %d ns, "
> "%#5.5lx-%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
> mem->speed, mem->sys_start, mem->sys_stop, mem->card_start);
>
> if ((mem->map >= PCMCIA_MEM_WIN_NO) || (mem->sys_start > mem->sys_stop)
> || ((mem->sys_stop - mem->sys_start) >= PCMCIA_MEM_WIN_SIZE)
> || (mem->card_start >= 0x04000000)
> || (mem->sys_start & 0xfff) /* 4KByte resolution */
> || (mem->card_start & 0xfff))
> return -EINVAL;
>
> if((reg = m8xx_get_graycode(PCMCIA_MEM_WIN_SIZE)) == -1) {
> printk( "Cannot set size to 0x%08x.\n", PCMCIA_MEM_WIN_SIZE);
> return -EINVAL;
> }
> reg <<= 27;
>
> winnr = (lsock * PCMCIA_MEM_WIN_NO) + mem->map;
>
> /* Setup the window in the pcmcia controller */
>
> w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
> w += winnr;
>
> reg |= lsock << 2;
>
> reg |= m8xx_get_speed(mem->speed, 0);
>
> if(mem->flags & MAP_ATTRIB)
> reg |= M8XX_PCMCIA_POR_ATTRMEM;
>
> if(mem->flags & MAP_WRPROT)
> reg |= M8XX_PCMCIA_POR_WRPROT;
>
> if(mem->flags & MAP_16BIT)
> reg |= M8XX_PCMCIA_POR_16BIT;
>
> if(mem->flags & MAP_ACTIVE)
> reg |= M8XX_PCMCIA_POR_VALID;
>
> w->or = reg;
>
> DEBUG(3, "Socket %u: Mapped memory window %u at %#8.8x, "
> "OR = %#8.8x.\n", lsock, mem->map, w->br, w->or);
>
> if(mem->flags & MAP_ACTIVE) {
>
> mem->sys_stop -= mem->sys_start;
>
> /* get the new base address */
>
> mem->sys_start = PCMCIA_MEM_WIN_BASE +
> (PCMCIA_MEM_WIN_SIZE * winnr)
> + mem->card_start;
>
> mem->sys_stop += mem->sys_start;
> }
>
> DEBUG(3, "SetMemMap(%d, %d, %#2.2x, %d ns, "
> "%#5.5lx-%#5.5lx, %#5.5x)\n", lsock, mem->map, mem->flags,
> mem->speed, mem->sys_start, mem->sys_stop, mem->card_start);
>
> /* copy the struct and modify the copy */
>
> old = &s->mem_win[mem->map];
>
> *old = *mem;
> old->flags &= (MAP_ATTRIB
> | MAP_WRPROT
> | MAP_16BIT
> | MAP_ACTIVE);
>
> return 0;
>}
>// was s
>static int m8xx_sock_init(struct pcmcia_socket *sock)
>{
> int i;
> int s = container_of(sock, struct socket_info_t, socket)->slot;
> pccard_io_map io = { 0, 0, 0, 0, 1 };
> pccard_mem_map mem = { 0, 0, 0, 0, 0, 0 };
>
> DEBUG(3, "sock_init(%d)\n", s);
>
> mem.sys_stop = 0x1000;
> m8xx_set_socket(sock, &dead_socket);
> for (i = 0; i < PCMCIA_IO_WIN_NO; i++) {
> io.map = i;
> m8xx_set_io_map(sock, &io);
> }
> for (i = 0; i < PCMCIA_MEM_WIN_NO; i++) {
> mem.map = i;
> m8xx_set_mem_map(sock, &mem);
> }
>
> return 0;
>
>}
>
>static int m8xx_suspend(struct pcmcia_socket *sock)
>{
> return(m8xx_set_socket(sock, &dead_socket));
>}
>static void m8xx_proc_setup(unsigned int sock, struct proc_dir_entry *base)
>{
>}
>/* ------------------------------------------------------------------------- */
>
>static struct pccard_operations m8xx_services = {
> .init = m8xx_sock_init,
> .suspend = m8xx_suspend,
> .register_callback = m8xx_register_callback,
> //&m8xx_inquire_socket,
> .get_status = m8xx_get_status,
> .get_socket = m8xx_get_socket,
> .set_socket = m8xx_set_socket,
>// &m8xx_get_io_map,
> .set_io_map = m8xx_set_io_map,
>// &m8xx_get_mem_map,
> .set_mem_map = m8xx_set_mem_map,
>// &m8xx_proc_setup
>};
>
>static int __init m8xx_init(void)
>{
> servinfo_t serv;
> pcmcia_win_t *w;
> u_int i,m;
> struct sock_info_t *sock;
>
> PCMCIA_INFO("%s\n", version);
>/* CardServices(GetCardServicesInfo, &serv);
> if (serv.Revision != CS_RELEASE_CODE) {
> PCMCIA_ERROR("Card Services release does not match!\n");
> return -1;
> }*/
>
> if (driver_register(&m8xx_driver))
> return -1;
>
> PCMCIA_INFO(PCMCIA_BOARD_MSG " using " PCMCIA_SLOT_MSG
> " with IRQ %u.\n", pcmcia_schlvl);
>
> /* Configure Status change interrupt */
>
> if(request_irq(pcmcia_schlvl, m8xx_interrupt, 0,
> "m8xx_pcmcia", NULL)) {
> PCMCIA_ERROR("Cannot allocate IRQ %u for SCHLVL!\n",
> pcmcia_schlvl);
> return -1;
> }
>
> w = (void *) &((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pbr0;
>
>// socket[0].slot = 0;
>// socket[1].slot = 1;
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_pscr =
> M8XX_PCMCIA_MASK(0)| M8XX_PCMCIA_MASK(1);
> ((immap_t *)IMAP_ADDR)->im_pcmcia.pcmc_per
> &= ~(M8XX_PCMCIA_MASK(0)| M8XX_PCMCIA_MASK(1));
>
>/* connect interrupt and disable CxOE */
>
> M8XX_PGCRX(0) = M8XX_PGCRX_CXOE |
> (mk_int_int_mask(pcmcia_schlvl) << 16);
> M8XX_PGCRX(1) = M8XX_PGCRX_CXOE |
> (mk_int_int_mask(pcmcia_schlvl) << 16);
>
>/* intialize the fixed memory windows */
>
> for(i = 0; i < PCMCIA_SOCKETS_NO; i++){
> for(m = 0; m < PCMCIA_MEM_WIN_NO; m++) {
> w->br = PCMCIA_MEM_WIN_BASE +
> (PCMCIA_MEM_WIN_SIZE
> * (m + i * PCMCIA_MEM_WIN_NO));
>
> w->or = 0; /* set to not valid */
>
> w++;
> }
> }
>
>/* turn off voltage */
> voltage_set(0, 0, 0);
> voltage_set(1, 0, 0);
>
>/* Enable external hardware */
> hardware_enable(0);
> hardware_enable(1);
>
>
> platform_device_register(&m8xx_device);
>
> for (i = 0 ; i < PCMCIA_SOCKETS_NO; i++) {
> socket[i].slot = i;
> socket[i].socket.owner = THIS_MODULE;
> socket[i].socket.features = SS_CAP_PCCARD | SS_CAP_MEM_ALIGN
> | SS_CAP_STATIC_MAP;
> socket[i].socket.irq_mask = 0x000;
> socket[i].socket.map_size = 0x1000;
> socket[i].socket.io_offset = 0;
> socket[i].socket.pci_irq = i ? 7 : 9;
> socket[i].socket.ops = &m8xx_services;
> socket[i].socket.cb_dev = NULL;
> socket[i].socket.dev.dev = &m8xx_device.dev;
>
> }
>
> for (i = 0; i < PCMCIA_SOCKETS_NO; i++) {
> pcmcia_register_socket(&socket[i].socket);
> }
>
>// if(register_ss_entry(PCMCIA_SOCKETS_NO, &m8xx_services) != 0) {
>// PCMCIA_ERROR("register_ss_entry() failed.\n");
>// m8xx_shutdown();
>// return -ENODEV;
>// }
>
> return 0;
>}
>
>static void __exit m8xx_exit(void)
>{
> int i;
>// unregister_ss_entry(&m8xx_services);
>
> for (i = 0; i < PCMCIA_SOCKETS_NO; i++)
> pcmcia_unregister_socket(&socket[i].socket);
>
>
> m8xx_shutdown();
>}
>
>module_init(m8xx_init);
>module_exit(m8xx_exit);
>
>
>------------------------------------------------------------------------
>
>_______________________________________________
>Linuxppc-embedded mailing list
>Linuxppc-embedded at ozlabs.org
>https://ozlabs.org/mailman/listinfo/linuxppc-embedded
>
Marcelo Hi
I'm gonna definately try this and get back to you.
Thanks
Regards
Pantelis
More information about the Linuxppc-embedded
mailing list