URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [rtos/] [ecos-3.0/] [packages/] [io/] [pcmcia/] [current/] [src/] [pcmcia.c] - Rev 825
Go to most recent revision | Compare with Previous | Blame | View Log
//========================================================================== // // io/pcmcia/pcmcia.c // // PCMCIA support (Card Services) // //========================================================================== // ####ECOSGPLCOPYRIGHTBEGIN#### // ------------------------------------------- // This file is part of eCos, the Embedded Configurable Operating System. // Copyright (C) 1998, 1999, 2000, 2001, 2002 Free Software Foundation, Inc. // // eCos is free software; you can redistribute it and/or modify it under // the terms of the GNU General Public License as published by the Free // Software Foundation; either version 2 or (at your option) any later // version. // // eCos is distributed in the hope that it will be useful, but WITHOUT // ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License // for more details. // // You should have received a copy of the GNU General Public License // along with eCos; if not, write to the Free Software Foundation, Inc., // 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. // // As a special exception, if other files instantiate templates or use // macros or inline functions from this file, or you compile this file // and link it with other works to produce a work based on this file, // this file does not by itself cause the resulting work to be covered by // the GNU General Public License. However the source code for this file // must still be made available in accordance with section (3) of the GNU // General Public License v2. // // This exception does not invalidate any other reasons why a work based // on this file might be covered by the GNU General Public License. // ------------------------------------------- // ####ECOSGPLCOPYRIGHTEND#### //========================================================================== //#####DESCRIPTIONBEGIN#### // // Author(s): gthomas // Contributors: gthomas // Date: 2000-07-06 // Purpose: PCMCIA support // Description: // //####DESCRIPTIONEND#### // //========================================================================== #include <pkgconf/io_pcmcia.h> #include <cyg/io/pcmcia.h> #include <cyg/infra/diag.h> #if CYGHWR_IO_PCMCIA_DEVICE == 0 #error Need hardware package for PCMCIA support #endif #define CF_NUM_SLOTS CYGHWR_IO_PCMCIA_DEVICE static struct cf_slot cf_slots[CF_NUM_SLOTS]; // Implementation routines void cf_hwr_init(struct cf_slot *slot); void cf_hwr_change_state(struct cf_slot *slot, int desired_state); void cf_hwr_clear_interrupt(struct cf_slot *slot); bool cf_get_CIS(struct cf_slot *slot, unsigned char id, unsigned char *buf, int *len, int *ptr) { int i, size; unsigned char *cis = slot->attr; unsigned char *cis_end = cis + slot->attr_length; cis += *ptr; while (cis < cis_end) { if (*cis == 0xFF) { break; } if (*cis == id) { size = *(cis+2) + 2; for (i = 0; i < size; i++) { *buf++ = *cis; cis += 2; } *len = size; *ptr = (unsigned long)(cis - slot->attr); return true; } else { // Skip to next entry cis += (*(cis+2) * 2) + 4; } } return false; } void cf_set_COR(struct cf_slot *slot, unsigned long cor, unsigned char val) { volatile unsigned char *cfg = slot->attr; cfg[cor] = val; } static void cf_parse_power_structure(unsigned char **buf) { unsigned char *bp = *buf; unsigned char tpce_pd = *bp++; unsigned char settings; int indx; for (indx = 6; indx >= 0; indx--) { if (tpce_pd & (1<<indx)) { settings = *bp++; // main value if (settings & 0x80) { bp++; // extension byte - FIXME } } } *buf = bp; } static void cf_parse_timing_structure(unsigned char **buf) { unsigned char *bp = *buf; unsigned char tpce_td = *bp++; if ((tpce_td & 0x1C) != 0x1C) { // diag_printf("READY = %x.%x\n",(tpce_td & 0x1C)>>2, *bp); bp++; } if ((tpce_td & 0x03) != 0x03) { // diag_printf("WAIT = %x.%x\n",(tpce_td & 0x03)>>0, *bp); bp++; } *buf = bp; } static void cf_parse_IO_space_structure(unsigned char **buf, struct cf_io_space *io_space) { unsigned char *bp = *buf; unsigned char tpce_io = *bp++; unsigned char rd; unsigned long base = 0, length = 0; int i; io_space->mode = (tpce_io & 0x60) >> 5; if (tpce_io & 0x80) { rd = *bp++; io_space->num_addrs = (rd & 0x0F) + 1; for (i = 0; i < io_space->num_addrs; i++) { // Address switch ((rd & 0x30) >> 4) { case 0: break; // Not present (shouldn't happen) case 1: base = *bp++; break; case 2: base = (bp[1] << 8) | bp[0]; bp += 2; break; case 3: base = (bp[3] << 24) | (bp[2] << 16) | (bp[1] << 8) | bp[0]; bp += 4; break; } io_space->base[i] = base; // Length switch ((rd & 0xC0) >> 6) { case 0: break; // Not present (shouldn't happen) case 1: length = *bp++; break; case 2: length = (bp[1] << 8) | bp[0]; bp += 2; break; case 3: length = (bp[3] << 24) | (bp[2] << 16) | (bp[1] << 8) | bp[0]; bp += 4; break; } length++; io_space->size[i] = length; // diag_printf("IO addr %d - base: %x, length: %x\n", i, base, length); } } *buf = bp; } bool cf_parse_cftable(unsigned char *buf, int len, struct cf_cftable *cftable) { unsigned char tpce_indx, tpce_fs; if (*buf++ != CF_CISTPL_CFTABLE_ENTRY) { diag_printf("%s - called with invalid CIS: %x\n", __FUNCTION__, *--buf); return false; } buf++; // Skip length/link tpce_indx = *buf++; cftable->cor = tpce_indx & 0x3F; if (tpce_indx & 0x80) { cftable->interface = *buf++; } cftable->feature_select = tpce_fs = *buf++; if (tpce_fs & 0x01) { cf_parse_power_structure(&buf); } if (tpce_fs & 0x02) { cf_parse_power_structure(&buf); } if (tpce_fs & 0x04) { cf_parse_timing_structure(&buf); } if (tpce_fs & 0x08) { cf_parse_IO_space_structure(&buf, &cftable->io_space); } return true; } bool cf_parse_config(unsigned char *buf, int len, struct cf_config *config) { unsigned char tpcc_sz; int i; if (*buf++ != CF_CISTPL_CONFIG) { diag_printf("%s - called with invalid CIS: %x\n", __FUNCTION__, *--buf); return false; } buf++; // Skip length/link tpcc_sz = *buf++; buf++; // Skip 'last' pointer config->base = 0; for (i = (tpcc_sz & 0x03); i >= 0; i--) { config->base = (config->base << 8) | buf[i]; } buf += (tpcc_sz & 0x03) + 1; config->mask_length = ((tpcc_sz & 0x3C) >> 2) + 1; for (i = 0; i < config->mask_length; i++) { config->mask[i] = *buf++; } return true; } // // Return a pointer to the slot descriptor for a given slot // struct cf_slot * cf_get_slot(int indx) { if ((indx >= 0) && (indx < CF_NUM_SLOTS)) { return &cf_slots[indx]; } else { diag_printf("PCMCIA: Invalid slot %d\n", indx); return (struct cf_slot *)0; } } // // Initialize all PCMCIA (Compact Flash) slots // void cf_init(void) { int i; for (i = 0; i < CF_NUM_SLOTS; i++) { cf_slots[i].index = i; cf_hwr_init(&cf_slots[i]); } } // // Transition a card/slot // void cf_change_state(struct cf_slot *slot, int desired_state) { cf_hwr_change_state(slot, desired_state); } // // Register an interrupt handler // void cf_register_handler(struct cf_slot *slot, void (*handler)(int, int, void *), void *param) { slot->irq_handler.handler = handler; slot->irq_handler.param = param; } // // Allow interrupt function to acknowledge interrupt // void cf_clear_interrupt(struct cf_slot *slot) { cf_hwr_clear_interrupt(slot); }
Go to most recent revision | Compare with Previous | Blame | View Log