Subversion Repositories openrisc_2011-10-31

//==========================================================================

//

//      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 Red Hat, 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.,

// 59 Temple Place, Suite 330, Boston, MA 02111-1307 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.

//

// This exception does not invalidate any other reasons why a work based on

// this file might be covered by the GNU General Public License.

//

// Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.

// at http://sources.redhat.com/ecos/ecos-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);

}