Subversion Repositories openrisc

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

//

//      strata.c

//

//      Flash programming

//

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

//####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, hmt

// Contributors: gthomas

// Date:         2001-02-14

// Purpose:      

// Description:  

//              

//####DESCRIPTIONEND####

//

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

#include <pkgconf/system.h>

#include <pkgconf/hal.h>

#include <cyg/hal/hal_arch.h>

#include <cyg/hal/hal_cache.h>

#define  _FLASH_PRIVATE_

#include <cyg/io/flash.h>

#include "strata.h"

#define _si(p) ((p[1]<<8)|p[0])

extern void diag_dump_buf(void *buf, CYG_ADDRWORD len);

extern int strncmp(const char *s1, const char *s2, size_t len);

extern void *memcpy( void *, const void *, size_t );

int

flash_hwr_init(void)

{

    struct FLASH_query data, *qp;

    extern char flash_query[], flash_query_end[];

    typedef int code_fun(unsigned char *);

    code_fun *_flash_query;

    int code_len, stat, num_regions, region_size, buffer_size;

    int icache_on, dcache_on;

    HAL_DCACHE_IS_ENABLED(dcache_on);

    HAL_ICACHE_IS_ENABLED(icache_on);

    // Copy 'program' code to RAM for execution

    code_len = (unsigned long)&flash_query_end - (unsigned long)&flash_query;

    _flash_query = (code_fun *)flash_info.work_space;

    memcpy(_flash_query, &flash_query, code_len);

    if (dcache_on) {

        HAL_DCACHE_SYNC();  // Should guarantee this code will run

    }

    if (icache_on) {

        HAL_ICACHE_DISABLE(); // is also required to avoid old contents

    }

    stat = (*_flash_query)((unsigned char *)&data);

    if (icache_on) {

        HAL_ICACHE_ENABLE();

    }

    qp = &data;

    if ( (qp->manuf_code == FLASH_Intel_code)

#ifdef CYGOPT_FLASH_IS_BOOTBLOCK

         // device types go as follows: 0x90 for 16-bits, 0xD0 for 8-bits,

         // plus 0 or 1 for -T (Top Boot) or -B (Bottom Boot)

         //     [FIXME: whatever that means :FIXME]

         // [I think it means the boot blocks are top/bottom of addr space]

         // plus the following size codes:

         //    0: 16Mbit    2:  8Mbit    4:  4Mbit

         //    6: 32Mbit    8: 64Mbit

#if 16 == CYGNUM_FLASH_WIDTH         

         && (0x90 == (0xF0 & qp->device_code)) // 16-bit devices

#elif 8 == CYGNUM_FLASH_WIDTH

         && (0xD0 == (0xF0 & qp->device_code)) // 8-bit devices

#else

         && 0

#error Only understand 16 and 8-bit bootblock flash types

#endif

        ) {

        int lookup[] = { 16, 8, 4, 32, 64 };

#define BLOCKSIZE (0x10000)

        region_size = BLOCKSIZE;

        num_regions = qp->device_code & 0x0F;

        num_regions >>= 1;

        if ( num_regions > 4 )

            goto flash_type_unknown;

        num_regions = lookup[num_regions];

        num_regions *= 1024 * 1024;     // to bits

        num_regions /= 8;               // to bytes

        num_regions /= BLOCKSIZE;       // to blocks

        buffer_size = 0;

#else // CYGOPT_FLASH_IS_BOOTBLOCK

         && (strncmp(qp->id, "QRY", 3) == 0)) {

        num_regions = _si(qp->num_regions)+1;

        region_size = _si(qp->region_size)*256;

        if (_si(qp->buffer_size)) {

            buffer_size = CYGNUM_FLASH_DEVICES << _si(qp->buffer_size);

        } else {

            buffer_size = 0;

        }

#endif // Not CYGOPT_FLASH_IS_BOOTBLOCK

        flash_info.block_size = region_size*CYGNUM_FLASH_DEVICES;

        flash_info.buffer_size = buffer_size;

        flash_info.blocks = num_regions;

        flash_info.start = (void *)CYGNUM_FLASH_BASE;

        flash_info.end = (void *)(CYGNUM_FLASH_BASE +

                        (num_regions*region_size*CYGNUM_FLASH_DEVICES));

#ifdef CYGNUM_FLASH_BASE_MASK

        // Then this gives us a maximum size for the (visible) device.

        // This is to cope with oversize devices fitted, with some high

        // address lines ignored.

        if ( ((unsigned int)flash_info.start & CYGNUM_FLASH_BASE_MASK) !=

             (((unsigned int)flash_info.end - 1) & CYGNUM_FLASH_BASE_MASK ) ) {

            // then the size of the device appears to span >1 device-worth!

            unsigned int x;

            x = (~(CYGNUM_FLASH_BASE_MASK)) + 1; // expected device size

            x += (unsigned int)flash_info.start;

            if ( x < (unsigned int)flash_info.end ) { // 2nd sanity check

                (*flash_info.pf)("\nFLASH: Oversized device!  End addr %p changed to %p\n",

                       flash_info.end, (void *)x );

                flash_info.end = (void *)x;

                // Also adjust the block count else unlock crashes!

                x = ((cyg_uint8 *)flash_info.end - (cyg_uint8 *)flash_info.start)

                    / flash_info.block_size;

                flash_info.blocks = x;

            }

        }

#endif // CYGNUM_FLASH_BASE_MASK

        return FLASH_ERR_OK;

    }

#ifdef CYGOPT_FLASH_IS_BOOTBLOCK

 flash_type_unknown:

#endif

    (*flash_info.pf)("Can't identify FLASH, sorry, man %x, dev %x, id [%4s] stat %x\n",

           qp->manuf_code, qp->device_code, qp->id, stat );

    diag_dump_buf(qp, sizeof(data));

    return FLASH_ERR_HWR;

}

// Map a hardware status to a package error

int

flash_hwr_map_error(int err)

{

    if (err & FLASH_ErrorMask) {

        (*flash_info.pf)("Err = %x\n", err);

        if (err & FLASH_ErrorProgram)

            return FLASH_ERR_PROGRAM;

        else if (err & FLASH_ErrorErase)

            return FLASH_ERR_ERASE;

        else

            return FLASH_ERR_HWR;  // FIXME

    } else {

        return FLASH_ERR_OK;

    }

}

// See if a range of FLASH addresses overlaps currently running code

bool

flash_code_overlaps(void *start, void *end)

{

    extern char _stext[], _etext[];

    return ((((unsigned long)&_stext >= (unsigned long)start) &&

             ((unsigned long)&_stext < (unsigned long)end)) ||

            (((unsigned long)&_etext >= (unsigned long)start) &&

             ((unsigned long)&_etext < (unsigned long)end)));

}

// EOF strata.c