URL
https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk
Subversion Repositories openrisc_me
[/] [openrisc/] [trunk/] [rtos/] [ecos-2.0/] [packages/] [io/] [flash/] [v2_0/] [src/] [flashiodev.c] - Rev 308
Go to most recent revision | Compare with Previous | Blame | View Log
//========================================================================== // // flashiodev.c // // Flash device interface to I/O subsystem // //========================================================================== //####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): jlarmour // Contributors: // Date: 2002-01-16 // Purpose: // Description: // //####DESCRIPTIONEND#### // //========================================================================== #define _FLASH_PRIVATE_ #include <pkgconf/io_flash.h> #include <errno.h> #include <cyg/infra/cyg_type.h> #include <cyg/io/devtab.h> #include <cyg/io/config_keys.h> #include <cyg/io/flash.h> #include <string.h> // memcpy #define MIN(x,y) ((x)<(y) ? (x) : (y)) // 1 per devtab entry, so only 1 for now static char flashiodev_workspaces[1][FLASH_MIN_WORKSPACE]; static int dummy_printf( const char *fmt, ... ) {return 0;} static bool flashiodev_init( struct cyg_devtab_entry *tab ) { char *ws = (char *)tab->priv; int stat = flash_init( ws, FLASH_MIN_WORKSPACE, &dummy_printf ); if ( stat == 0 ) return true; else return false; } // flashiodev_init() #if 0 static Cyg_ErrNo flashiodev_lookup( struct cyg_devtab_entry **tab, struct cyg_devtab_entry *sub_tab, const char *name) { } // flashiodev_lookup() #endif static Cyg_ErrNo flashiodev_bread( cyg_io_handle_t handle, void *buf, cyg_uint32 *len, cyg_uint32 pos) { char *startpos = (char *)flash_info.start + pos + CYGNUM_IO_FLASH_BLOCK_OFFSET_1; #ifdef CYGPKG_INFRA_DEBUG // don't bother checking this all the time char *endpos = startpos + *len - 1; char *flashend = MIN( (char *)flash_info.end, ((char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 + CYGNUM_IO_FLASH_BLOCK_LENGTH_1)); if ( startpos < (char *)flash_info.start+CYGNUM_IO_FLASH_BLOCK_OFFSET_1 ) return -EINVAL; if ( endpos > flashend ) return -EINVAL; #endif memcpy( buf, startpos, *len ); return ENOERR; } // flashiodev_bread() static Cyg_ErrNo flashiodev_bwrite( cyg_io_handle_t handle, const void *buf, cyg_uint32 *len, cyg_uint32 pos ) { Cyg_ErrNo err = ENOERR; void *erraddr; char *startpos = (char *)flash_info.start + pos + CYGNUM_IO_FLASH_BLOCK_OFFSET_1; #ifdef CYGPKG_INFRA_DEBUG // don't bother checking this all the time char *endpos = startpos + *len - 1; char *flashend = MIN( (char *)flash_info.end, ((char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 + CYGNUM_IO_FLASH_BLOCK_LENGTH_1)); if ( startpos < (char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 ) return -EINVAL; if ( endpos > flashend ) return -EINVAL; #endif err = flash_program( startpos, (void *)buf, *len, &erraddr ); if ( err ) err = -EIO; // just something sane return err; } // flashiodev_bwrite() static Cyg_ErrNo flashiodev_get_config( cyg_io_handle_t handle, cyg_uint32 key, void* buf, cyg_uint32* len) { switch (key) { case CYG_IO_GET_CONFIG_FLASH_ERASE: { if ( *len != sizeof( cyg_io_flash_getconfig_erase_t ) ) return -EINVAL; { cyg_io_flash_getconfig_erase_t *e = (cyg_io_flash_getconfig_erase_t *)buf; char *startpos = (char *)flash_info.start + e->offset + CYGNUM_IO_FLASH_BLOCK_OFFSET_1; #ifdef CYGPKG_INFRA_DEBUG // don't bother checking this all the time char *endpos = startpos + e->len - 1; char *flashend = MIN( (char *)flash_info.end, ((char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 + CYGNUM_IO_FLASH_BLOCK_LENGTH_1)); if ( startpos < (char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 ) return -EINVAL; if ( endpos > flashend ) return -EINVAL; #endif e->flasherr = flash_erase( startpos, e->len, e->err_address ); } return ENOERR; } case CYG_IO_GET_CONFIG_FLASH_DEVSIZE: { if ( *len != sizeof( cyg_io_flash_getconfig_devsize_t ) ) return -EINVAL; { cyg_io_flash_getconfig_devsize_t *d = (cyg_io_flash_getconfig_devsize_t *)buf; //d->dev_size = flash_info.blocks * flash_info.block_size; d->dev_size = CYGNUM_IO_FLASH_BLOCK_LENGTH_1; } return ENOERR; } case CYG_IO_GET_CONFIG_FLASH_BLOCKSIZE: { cyg_io_flash_getconfig_blocksize_t *b = (cyg_io_flash_getconfig_blocksize_t *)buf; char *startpos = (char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 + b->offset; #ifdef CYGPKG_INFRA_DEBUG // don't bother checking this all the time char *flashend = MIN( (char *)flash_info.end, ((char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 + CYGNUM_IO_FLASH_BLOCK_LENGTH_1)); if ( startpos < (char *)flash_info.start + CYGNUM_IO_FLASH_BLOCK_OFFSET_1 ) return -EINVAL; if ( startpos > flashend ) return -EINVAL; #endif if ( *len != sizeof( cyg_io_flash_getconfig_blocksize_t ) ) return -EINVAL; // offset unused for now b->block_size = flash_info.block_size; return ENOERR; } default: return -EINVAL; } } // flashiodev_get_config() #if 0 static Cyg_ErrNo flashiodev_set_config( cyg_io_handle_t handle, cyg_uint32 key, const void* buf, cyg_uint32* len) { switch (key) { default: return -EINVAL; } } // flashiodev_set_config() #endif // get_config/set_config should be added later to provide the other flash // operations possible, like erase etc. BLOCK_DEVIO_TABLE( cyg_io_flashdev1_ops, &flashiodev_bwrite, &flashiodev_bread, 0, // no select &flashiodev_get_config, 0 // &flashiodev_set_config ); BLOCK_DEVTAB_ENTRY( cyg_io_flashdev1, CYGDAT_IO_FLASH_BLOCK_DEVICE_NAME_1, 0, &cyg_io_flashdev1_ops, &flashiodev_init, 0, // No lookup required &flashiodev_workspaces[0] ); // EOF flashiodev.c
Go to most recent revision | Compare with Previous | Blame | View Log