xCAT/xNBA
2
0
Fork 0
mirror of https://github.com/xcat2/xNBA.git synced 2024-12-15 15:51:44 +00:00
Code Issues Projects Releases Wiki Activity
6ab4b99f41
xNBA/src/core/i82365.c
Michael Brown 3d6123e69a Initial revision
2005-03-08 18:53:11 +00:00

657 lines
20 KiB
C
Raw Blame History

#ifdef CONFIG_PCMCIA
/*
* i82365.c
* Support for i82365 and similar ISA-to-PCMCIA bridges
*
* Taken from Linux kernel sources, distributed under GPL2
*
* Software distributed under the License is distributed on an "AS
* IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or
* implied. See the License for the specific language governing
* rights and limitations under the License.
*
* The initial developer of the original code is David A. Hinds
* <dahinds@users.sourceforge.net>. Portions created by David A. Hinds
* are Copyright (C) 1999 David A. Hinds. All Rights Reserved.
*
* Ported by: Anselm Martin Hoffmeister, Stockholm Projekt Computer-Service, Sankt Augustin/Bonn, GERMANY
*/
/*
*
*
* ******************************
* PLEASE DO NOT YET WORK ON THIS
* ******************************
*
* I'm still fixing it up on every end, so we most probably would interfere
* at some point. If there's anything obvious or better, not-so-obvious,
* please contact me by e-mail: anselm (AT) hoffmeister (DOT) be *THANKS*
*/
#include "../include/pcmcia.h"
#include "../include/pcmcia-opts.h"
#include "../include/i82365.h"
#ifndef CONFIG_ISA
#error PCMCIA_I82365 only works with ISA defined - set CONFIG_ISA
#endif
typedef enum pcic_id {
IS_I82365A, IS_I82365B, IS_I82365DF,
IS_IBM, IS_RF5Cx96, IS_VLSI, IS_VG468, IS_VG469,
IS_PD6710, IS_PD672X, IS_VT83C469,
} pcic_id;
/* Flags for classifying groups of controllers */
#define IS_VADEM 0x0001
#define IS_CIRRUS 0x0002
#define IS_TI 0x0004
#define IS_O2MICRO 0x0008
#define IS_VIA 0x0010
#define IS_TOPIC 0x0020
#define IS_RICOH 0x0040
#define IS_UNKNOWN 0x0400
#define IS_VG_PWR 0x0800
#define IS_DF_PWR 0x1000
#define IS_PCI 0x2000
#define IS_ALIVE 0x8000
typedef struct pcic_t {
char *name;
u_short flags;
} pcic_t;
static pcic_t pcic[] = {
{ "Intel i82365sl A step", 0 },
{ "Intel i82365sl B step", 0 },
{ "Intel i82365sl DF", IS_DF_PWR },
{ "IBM Clone", 0 },
{ "Ricoh RF5C296/396", 0 },
{ "VLSI 82C146", 0 },
{ "Vadem VG-468", IS_VADEM },
{ "Vadem VG-469", IS_VADEM|IS_VG_PWR },
{ "Cirrus PD6710", IS_CIRRUS },
{ "Cirrus PD672x", IS_CIRRUS },
{ "VIA VT83C469", IS_CIRRUS|IS_VIA },
};
typedef struct cirrus_state_t {
u_char misc1, misc2;
u_char timer[6];
} cirrus_state_t;
typedef struct vg46x_state_t {
u_char ctl, ema;
} vg46x_state_t;
typedef struct socket_info_t {
u_short type, flags;
socket_cap_t cap;
ioaddr_t ioaddr;
u_short psock;
u_char cs_irq, intr;
void (*handler)(void *info, u_int events);
void *info;
union {
cirrus_state_t cirrus;
vg46x_state_t vg46x;
} state;
} socket_info_t;
//static socket_info_t socket[8];
int i365_base = 0x3e0; // Default in Linux kernel
int cycle_time = 120; // External clock time in ns, 120ns =~ 8.33 MHz
int mydriverid = 0;
void phex ( unsigned char c );
/*static int to_cycles(int ns)
{
return ns/cycle_time;
}
*/
/*static int to_ns(int cycles)
{
return cycle_time*cycles;
}
*/
static u_char i365_get(u_short sock, u_short reg)
{
//unsigned long flags;
//spin_lock_irqsave(&bus_lock,flags);
{
ioaddr_t port = pccsock[sock].ioaddr;
u_char val;
reg = I365_REG(pccsock[sock].internalid, reg);
outb(reg, port); val = inb(port+1);
//spin_unlock_irqrestore(&bus_lock,flags);
return val;
}
}
static void i365_set(u_short sock, u_short reg, u_char data)
{
//unsigned long flags;
//spin_lock_irqsave(&bus_lock,flags);
{
ioaddr_t port = pccsock[sock].ioaddr;
u_char val = I365_REG(pccsock[sock].internalid, reg);
outb(val, port); outb(data, port+1);
//spin_unlock_irqrestore(&bus_lock,flags);
}
}
void add_socket_i365(u_short port, int psock, int type) {
pccsock[pccsocks].ioaddr = port;
pccsock[pccsocks].internalid = psock;
pccsock[pccsocks].type = type;
pccsock[pccsocks].flags = pcic[type].flags;
pccsock[pccsocks].drivernum = mydriverid;
pccsock[pccsocks].configoffset = -1;
// Find out if a card in inside that socket
pccsock[pccsocks].status = (( 12 == (i365_get(pccsocks,I365_STATUS)&12) ) ? HASCARD : EMPTY );
// *TODO* check if that's all
if ( 0 == (psock & 1) ) {
printf ( "Found a PCMCIA controller (i82365) at io %x, type '%s'\n", port, pcic[type].name );
// pccsock[pccsocks].status == HASCARD? "holds card":"empty" );
}
pccsocks++;
return;
}
void i365_bset(u_short sock, u_short reg, u_char mask) {
u_char d = i365_get(sock, reg);
d |= mask;
i365_set(sock, reg, d);
}
void i365_bclr(u_short sock, u_short reg, u_char mask) {
u_char d = i365_get(sock, reg);
d &= ~mask;
i365_set(sock, reg, d);
}
/*static void i365_bflip(u_short sock, u_short reg, u_char mask, int b)
{
u_char d = i365_get(sock, reg);
if (b)
d |= mask;
else
d &= ~mask;
i365_set(sock, reg, d);
}
*/
/*
static u_short i365_get_pair(u_short sock, u_short reg)
{
u_short a, b;
a = i365_get(sock, reg);
b = i365_get(sock, reg+1);
return (a + (b<<8));
}
*/
/*
static void i365_set_pair(u_short sock, u_short reg, u_short data)
{
i365_set(sock, reg, data & 0xff);
i365_set(sock, reg+1, data >> 8);
}
*/
int identify_i365 ( u_short port, u_short sock ) {
u_char val;
int type = -1;
/* Use the next free entry in the socket table */
pccsock[pccsocks].ioaddr = port;
pccsock[pccsocks].internalid = sock;
// *TODO* wakeup a sleepy cirrus controller?
if ((val = i365_get(pccsocks, I365_IDENT)) & 0x70)
return -1;
switch (val) {
case 0x82:
type = IS_I82365A; break;
case 0x83:
type = IS_I82365B; break;
case 0x84:
type = IS_I82365DF; break;
case 0x88: case 0x89: case 0x8a:
type = IS_IBM; break;
}
/* Check for Vadem VG-468 chips */
outb(0x0e, port);
outb(0x37, port);
i365_bset(pccsocks, VG468_MISC, VG468_MISC_VADEMREV);
val = i365_get(pccsocks, I365_IDENT);
if (val & I365_IDENT_VADEM) {
i365_bclr(pccsocks, VG468_MISC, VG468_MISC_VADEMREV);
type = ((val & 7) >= 4) ? IS_VG469 : IS_VG468;
}
/* Check for Ricoh chips */
val = i365_get(pccsocks, RF5C_CHIP_ID);
if ((val == RF5C_CHIP_RF5C296) || (val == RF5C_CHIP_RF5C396)) type = IS_RF5Cx96;
/* Check for Cirrus CL-PD67xx chips */
i365_set(pccsocks, PD67_CHIP_INFO, 0);
val = i365_get(pccsocks, PD67_CHIP_INFO);
if ((val & PD67_INFO_CHIP_ID) == PD67_INFO_CHIP_ID) {
val = i365_get(pccsocks, PD67_CHIP_INFO);
if ((val & PD67_INFO_CHIP_ID) == 0) {
type = (val & PD67_INFO_SLOTS) ? IS_PD672X : IS_PD6710;
i365_set(pccsocks, PD67_EXT_INDEX, 0xe5);
if (i365_get(pccsocks, PD67_EXT_INDEX) != 0xe5) type = IS_VT83C469;
}
}
return type;
}
int init_i82365(void) {
int i, j, sock, k, ns, id;
//unsigned int ui,uj;
//unsigned char * upc;
ioaddr_t port;
int i82365s = 0;
// Change from kernel: No irq init, no check_region, no isapnp support
// No ignore socket, no extra sockets to check (so it's easier here :-/)
// Probably we don't need any of them; in case YOU do, SHOUT AT ME!
id = identify_i365(i365_base, 0);
if ((id == IS_I82365DF) && (identify_i365(i365_base, 1) != id)) {
for (i = 0; i < 4; i++) {
port = i365_base + ((i & 1) << 2) + ((i & 2) << 1);
sock = (i & 1) << 1;
if (identify_i365(port, sock) == IS_I82365DF) {
add_socket_i365(port, sock, IS_VLSI);
}
}
} else {
for (i = 0; i < 4; i += 2) {
port = i365_base + 2*(i>>2);
sock = (i & 3);
id = identify_i365(port, sock);
if (id < 0) continue;
for (j = ns = 0; j < 2; j++) {
/* Does the socket exist? */
if (identify_i365(port, sock+j) < 0) continue;
/* Check for bad socket decode */
for (k = 0; k <= i82365s; k++)
i365_set(k, I365_MEM(0)+I365_W_OFF, k);
for (k = 0; k <= i82365s; k++)
if (i365_get(k, I365_MEM(0)+I365_W_OFF) != k)
break;
if (k <= i82365s) break;
add_socket_i365(port, sock+j, id); ns++;
}
}
}
return 0;
/* printf ( "Selecting config 1: io 0x300 @byte 87*2.." );
upc[(2*87)] = 2;
i365_bclr(1, I365_ADDRWIN, 1 );
i365_set(1,I365_INTCTL, 0x65 ); //no-reset, memory-card
i365_set(1, I365_IO(0)+0, 0x20 );
i365_set(1, I365_IO(0)+1, 0x03 );
i365_set(1, I365_IO(0)+2, 0x3f );
i365_set(1, I365_IO(0)+3, 0x03 );
i365_set(1, 0x3a, 0x05 );
i365_set(1, 0x3b, 0x05 );
i365_set(1, 0x3c, 0x05 );
i365_set(1, 0x3d, 0x05 );
i365_set(1, 0x3e, 0x05 );
i365_set(1, 0x3f, 0x05 );
i365_set(1, 0x07, 0x0a );
i365_set(1, I365_ADDRWIN, 0x40 ); // 0x40
printf ( "!\n" ); getchar();
printf ( "\n" );
return 0; */
}
void phex ( unsigned char c ) {
unsigned char a = 0, b = 0;
b = ( c & 0xf );
if ( b > 9 ) b += ('a'-'9'-1);
b += '0';
a = ( c & 0xf0 ) >> 4;
if ( a > 9 ) a += ('a'-'9'-1);
a += '0';
printf ( "%c%c ", a, b );
return;
}
int deinit_i82365(void) {
printf("Deinitializing i82365\n" );
return 0;
}
/*static int i365_get_status(u_short sock, u_int *value)
{
u_int status;
status = i365_get(sock, I365_STATUS);
*value = ((status & I365_CS_DETECT) == I365_CS_DETECT)
? SS_DETECT : 0;
if (i365_get(sock, I365_INTCTL) & I365_PC_IOCARD)
*value |= (status & I365_CS_STSCHG) ? 0 : SS_STSCHG;
else {
*value |= (status & I365_CS_BVD1) ? 0 : SS_BATDEAD;
*value |= (status & I365_CS_BVD2) ? 0 : SS_BATWARN;
}
*value |= (status & I365_CS_WRPROT) ? SS_WRPROT : 0;
*value |= (status & I365_CS_READY) ? SS_READY : 0;
*value |= (status & I365_CS_POWERON) ? SS_POWERON : 0;
#ifdef CONFIG_ISA
if (pccsock[sock].type == IS_VG469) {
status = i365_get(sock, VG469_VSENSE);
if (pccsock[sock].internalid & 1) {
*value |= (status & VG469_VSENSE_B_VS1) ? 0 : SS_3VCARD;
*value |= (status & VG469_VSENSE_B_VS2) ? 0 : SS_XVCARD;
} else {
*value |= (status & VG469_VSENSE_A_VS1) ? 0 : SS_3VCARD;
*value |= (status & VG469_VSENSE_A_VS2) ? 0 : SS_XVCARD;
}
}
#endif
printf("i82365: GetStatus(%d) = %#4.4x\n", sock, *value);
return 0;
} //i365_get_status
*/
/*static int i365_set_socket(u_short sock, socket_state_t *state)
{
socket_info_t *t = &socket[sock];
u_char reg;
printf("i82365: SetSocket(%d, flags %#3.3x, Vcc %d, Vpp %d, "
"io_irq %d, csc_mask %#2.2x)\n", sock, state->flags,
state->Vcc, state->Vpp, state->io_irq, state->csc_mask);
printf ("\nERROR:UNIMPLEMENTED\n" );
return 0;
// First set global controller options
// set_bridge_state(sock); *TODO* check: need this here?
// IO card, RESET flag, IO interrupt
reg = t->intr;
if (state->io_irq != t->cap.pci_irq) reg |= state->io_irq;
reg |= (state->flags & SS_RESET) ? 0 : I365_PC_RESET;
reg |= (state->flags & SS_IOCARD) ? I365_PC_IOCARD : 0;
i365_set(sock, I365_INTCTL, reg);
reg = I365_PWR_NORESET;
if (state->flags & SS_PWR_AUTO) reg |= I365_PWR_AUTO;
if (state->flags & SS_OUTPUT_ENA) reg |= I365_PWR_OUT;
if (t->flags & IS_CIRRUS) {
if (state->Vpp != 0) {
if (state->Vpp == 120)
reg |= I365_VPP1_12V;
else if (state->Vpp == state->Vcc)
reg |= I365_VPP1_5V;
else return -EINVAL;
}
if (state->Vcc != 0) {
reg |= I365_VCC_5V;
if (state->Vcc == 33)
i365_bset(sock, PD67_MISC_CTL_1, PD67_MC1_VCC_3V);
else if (state->Vcc == 50)
i365_bclr(sock, PD67_MISC_CTL_1, PD67_MC1_VCC_3V);
else return -EINVAL;
}
} else if (t->flags & IS_VG_PWR) {
if (state->Vpp != 0) {
if (state->Vpp == 120)
reg |= I365_VPP1_12V;
else if (state->Vpp == state->Vcc)
reg |= I365_VPP1_5V;
else return -EINVAL;
}
if (state->Vcc != 0) {
reg |= I365_VCC_5V;
if (state->Vcc == 33)
i365_bset(sock, VG469_VSELECT, VG469_VSEL_VCC);
else if (state->Vcc == 50)
i365_bclr(sock, VG469_VSELECT, VG469_VSEL_VCC);
else return -EINVAL;
}
} else if (t->flags & IS_DF_PWR) {
switch (state->Vcc) {
case 0: break;
case 33: reg |= I365_VCC_3V; break;
case 50: reg |= I365_VCC_5V; break;
default: return -EINVAL;
}
switch (state->Vpp) {
case 0: break;
case 50: reg |= I365_VPP1_5V; break;
case 120: reg |= I365_VPP1_12V; break;
default: return -EINVAL;
}
} else {
switch (state->Vcc) {
case 0: break;
case 50: reg |= I365_VCC_5V; break;
default: return -EINVAL;
}
switch (state->Vpp) {
case 0: break;
case 50: reg |= I365_VPP1_5V | I365_VPP2_5V; break;
case 120: reg |= I365_VPP1_12V | I365_VPP2_12V; break;
default: return -EINVAL;
}
}
if (reg != i365_get(sock, I365_POWER))
i365_set(sock, I365_POWER, reg);
// Chipset-specific functions
if (t->flags & IS_CIRRUS) {
// Speaker control
i365_bflip(sock, PD67_MISC_CTL_1, PD67_MC1_SPKR_ENA,
state->flags & SS_SPKR_ENA);
}
// Card status change interrupt mask
reg = t->cs_irq << 4;
if (state->csc_mask & SS_DETECT) reg |= I365_CSC_DETECT;
if (state->flags & SS_IOCARD) {
if (state->csc_mask & SS_STSCHG) reg |= I365_CSC_STSCHG;
} else {
if (state->csc_mask & SS_BATDEAD) reg |= I365_CSC_BVD1;
if (state->csc_mask & SS_BATWARN) reg |= I365_CSC_BVD2;
if (state->csc_mask & SS_READY) reg |= I365_CSC_READY;
}
i365_set(sock, I365_CSCINT, reg);
i365_get(sock, I365_CSC);
return 0;
} // i365_set_socket
*/
/*static int i365_get_io_map(u_short sock, struct pccard_io_map *io)
{
u_char map, ioctl, addr;
printf ( "GETIOMAP unimplemented\n" ); return 0;
map = io->map;
if (map > 1) return -EINVAL;
io->start = i365_get_pair(sock, I365_IO(map)+I365_W_START);
io->stop = i365_get_pair(sock, I365_IO(map)+I365_W_STOP);
ioctl = i365_get(sock, I365_IOCTL);
addr = i365_get(sock, I365_ADDRWIN);
io->speed = to_ns(ioctl & I365_IOCTL_WAIT(map)) ? 1 : 0;
io->flags = (addr & I365_ENA_IO(map)) ? MAP_ACTIVE : 0;
io->flags |= (ioctl & I365_IOCTL_0WS(map)) ? MAP_0WS : 0;
io->flags |= (ioctl & I365_IOCTL_16BIT(map)) ? MAP_16BIT : 0;
io->flags |= (ioctl & I365_IOCTL_IOCS16(map)) ? MAP_AUTOSZ : 0;
printf("i82365: GetIOMap(%d, %d) = %#2.2x, %d ns, "
"%#4.4x-%#4.4x\n", sock, map, io->flags, io->speed,
io->start, io->stop);
return 0;
} // i365_get_io_map
*/
/*====================================================================*/
/*static int i365_set_io_map(u_short sock, struct pccard_io_map *io)
{
u_char map, ioctl;
printf("i82365: SetIOMap(%d, %d, %#2.2x, %d ns, "
"%#4.4x-%#4.4x)\n", sock, io->map, io->flags,
io->speed, io->start, io->stop);
printf ( "UNIMPLEMENTED\n" );
return 0;
map = io->map;
//if ((map > 1) || (io->start > 0xffff) || (io->stop > 0xffff) ||
if ((map > 1) ||
(io->stop < io->start)) return -EINVAL;
// Turn off the window before changing anything
if (i365_get(sock, I365_ADDRWIN) & I365_ENA_IO(map))
i365_bclr(sock, I365_ADDRWIN, I365_ENA_IO(map));
i365_set_pair(sock, I365_IO(map)+I365_W_START, io->start);
i365_set_pair(sock, I365_IO(map)+I365_W_STOP, io->stop);
ioctl = i365_get(sock, I365_IOCTL) & ~I365_IOCTL_MASK(map);
if (io->speed) ioctl |= I365_IOCTL_WAIT(map);
if (io->flags & MAP_0WS) ioctl |= I365_IOCTL_0WS(map);
if (io->flags & MAP_16BIT) ioctl |= I365_IOCTL_16BIT(map);
if (io->flags & MAP_AUTOSZ) ioctl |= I365_IOCTL_IOCS16(map);
i365_set(sock, I365_IOCTL, ioctl);
// Turn on the window if necessary
if (io->flags & MAP_ACTIVE)
i365_bset(sock, I365_ADDRWIN, I365_ENA_IO(map));
return 0;
} // i365_set_io_map
*/
/*
static int i365_set_mem_map(u_short sock, struct pccard_mem_map *mem)
{
u_short base, i;
u_char map;
printf("i82365: SetMemMap(%d, %d, %#2.2x, %d ns, %#5.5lx-%#5.5"
"lx, %#5.5x)\n", sock, mem->map, mem->flags, mem->speed,
mem->sys_start, mem->sys_stop, mem->card_start);
printf ( "UNIMPLEMENTED\n" );
return 0;
map = mem->map;
if ((map > 4) || (mem->card_start > 0x3ffffff) ||
(mem->sys_start > mem->sys_stop) || (mem->speed > 1000))
return -EINVAL;
if (!(socket[sock].flags & IS_PCI) &&
((mem->sys_start > 0xffffff) || (mem->sys_stop > 0xffffff)))
return -EINVAL;
// Turn off the window before changing anything
if (i365_get(sock, I365_ADDRWIN) & I365_ENA_MEM(map))
i365_bclr(sock, I365_ADDRWIN, I365_ENA_MEM(map));
base = I365_MEM(map);
i = (mem->sys_start >> 12) & 0x0fff;
if (mem->flags & MAP_16BIT) i |= I365_MEM_16BIT;
if (mem->flags & MAP_0WS) i |= I365_MEM_0WS;
i365_set_pair(sock, base+I365_W_START, i);
i = (mem->sys_stop >> 12) & 0x0fff;
switch (to_cycles(mem->speed)) {
case 0: break;
case 1: i |= I365_MEM_WS0; break;
case 2: i |= I365_MEM_WS1; break;
default: i |= I365_MEM_WS1 | I365_MEM_WS0; break;
}
i365_set_pair(sock, base+I365_W_STOP, i);
i = ((mem->card_start - mem->sys_start) >> 12) & 0x3fff;
if (mem->flags & MAP_WRPROT) i |= I365_MEM_WRPROT;
if (mem->flags & MAP_ATTRIB) i |= I365_MEM_REG;
i365_set_pair(sock, base+I365_W_OFF, i);
// Turn on the window if necessary
if (mem->flags & MAP_ACTIVE)
i365_bset(sock, I365_ADDRWIN, I365_ENA_MEM(map));
return 0;
} // i365_set_mem_map
*/
int i82365_interfacer ( interface_func_t func, int sockno, int par1, int par2, void* par3 ) {
//int i, j, k;
//u_int ui;
u_char *upc;
struct pcc_config_t * pccc;
switch ( func ) {
case INIT:
mydriverid = par1;
return init_i82365();
case SHUTDOWN:
i365_set(sockno, I365_ADDRWIN, i365_get(sockno, I365_ADDRWIN) & 0x20 );
i365_set(sockno, I365_INTCTL, 0x05 );
sleepticks(2);
i365_set(sockno,I365_INTCTL, 0x45 ); //no-reset, memory-card
break;
case MAPATTRMEM:
i365_set(sockno,I365_POWER, 0xb1 );
i365_set(sockno, I365_INTCTL, 0x05 );
sleepticks(2);
i365_set(sockno,I365_INTCTL, 0x45 ); //no-reset, memory-card
i365_set(sockno, I365_ADDRWIN, i365_get(sockno, I365_ADDRWIN) & 0x20 );
//i365_bclr(sockno, I365_ADDRWIN, 1 );
i365_set(sockno, I365_MEM(0)+0, ( par1 >> 12 )& 0xff ); //start
i365_set(sockno, I365_MEM(0)+1, ( par1 >> 20 ) & 0x0f );
i365_set(sockno, I365_MEM(0)+2, ((par1 + par2 - 1 ) >> 12 ) & 0xff ); //end
i365_set(sockno, I365_MEM(0)+3, (( par1 + par2 - 1 ) >> 20 ) & 0x0f );
i365_set(sockno, I365_MEM(0)+4, ((0x4000000 - par1) >> 12) & 0xff ); //offset low
i365_set(sockno, I365_MEM(0)+5, 0x40 | (((0x40000000 - par1) >> 12) & 0x3f));
i365_bset(sockno, I365_ADDRWIN, 1 );
if ( ! ( 1 & i365_get ( sockno, I365_ADDRWIN ) ) ) return 1;
break;
case UNMAPATTRMEM:
i365_set(sockno, I365_ADDRWIN, i365_get(sockno, I365_ADDRWIN) & 0x20 );
i365_set(sockno,I365_INTCTL, 0x45 ); //no-reset, memory-card
break;
case SELECTCONFIG: // Params: par1: config number; par3 config pointer pointer
if ( 0 > pccsock[sockno].configoffset ) return 1;
if ( NULL == (pccc = par3 ) ) return 2;
// write config number to
upc = ioremap ( MAP_ATTRMEM_TO, MAP_ATTRMEM_LEN );
if ( pccsock[sockno].configoffset > MAP_ATTRMEM_LEN ) return 3;
if ( ( par1 & 0x7fffffc0 ) ) return 4;
if ( pccc->index != par1 ) return 5;
upc[pccsock[sockno].configoffset] = ( upc[pccsock[sockno].configoffset] & 0xc0 ) | ( par1 & 0x3f );
i365_set(sockno, I365_IOCTL, (i365_get(sockno, I365_IOCTL) & 0xfe) | 0x20 ); // 16bit autosize
i365_set(sockno, I365_IO(0)+0, pccc->iowin & 0xff);
i365_set(sockno, I365_IO(0)+1, (pccc->iowin >> 8) & 0xff);
i365_set(sockno, I365_IO(0)+2, (pccc->iowin+pccc->iolen - 1) & 0xff);
i365_set(sockno, I365_IO(0)+3, ((pccc->iowin+pccc->iolen- 1) >> 8) & 0xff);
// Disable mem mapping
i365_bclr(sockno, I365_ADDRWIN, 1);
i365_set(sockno, I365_INTCTL, 0x65);
i365_bset(sockno, I365_ADDRWIN,0x40);
break;
default:
return -1; // ERROR: Unknown function called
}
return 0;
}
// get_mem_map[1320]
// cirrus_get_state/set/opts...
// vg46x_get_state/...
// get_bridge_state/...
#endif /* CONFIG_PCMCIA */
Reference in New Issue View Git Blame Copy Permalink