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.
-------------- next part --------------
/* -*- 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);
