VxWorks

开发平台：
C/C++

flashFsLib.c：源码内容
							/*
 * $Id: flashFsLib.c,v 1.4 Broadcom SDK $
 * $Copyright: Copyright 2008 Broadcom Corporation.
 * This program is the proprietary software of Broadcom Corporation
 * and/or its licensors, and may only be used, duplicated, modified
 * or distributed pursuant to the terms and conditions of a separate,
 * written license agreement executed between you and Broadcom
 * (an "Authorized License").  Except as set forth in an Authorized
 * License, Broadcom grants no license (express or implied), right
 * to use, or waiver of any kind with respect to the Software, and
 * Broadcom expressly reserves all rights in and to the Software
 * and all intellectual property rights therein.  IF YOU HAVE
 * NO AUTHORIZED LICENSE, THEN YOU HAVE NO RIGHT TO USE THIS SOFTWARE
 * IN ANY WAY, AND SHOULD IMMEDIATELY NOTIFY BROADCOM AND DISCONTINUE
 * ALL USE OF THE SOFTWARE.  
 *  
 * Except as expressly set forth in the Authorized License,
 *  
 * 1.     This program, including its structure, sequence and organization,
 * constitutes the valuable trade secrets of Broadcom, and you shall use
 * all reasonable efforts to protect the confidentiality thereof,
 * and to use this information only in connection with your use of
 * Broadcom integrated circuit products.
 *  
 * 2.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS
 * PROVIDED "AS IS" AND WITH ALL FAULTS AND BROADCOM MAKES NO PROMISES,
 * REPRESENTATIONS OR WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY,
 * OR OTHERWISE, WITH RESPECT TO THE SOFTWARE.  BROADCOM SPECIFICALLY
 * DISCLAIMS ANY AND ALL IMPLIED WARRANTIES OF TITLE, MERCHANTABILITY,
 * NONINFRINGEMENT, FITNESS FOR A PARTICULAR PURPOSE, LACK OF VIRUSES,
 * ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET POSSESSION OR
 * CORRESPONDENCE TO DESCRIPTION. YOU ASSUME THE ENTIRE RISK ARISING
 * OUT OF USE OR PERFORMANCE OF THE SOFTWARE.
 * 
 * 3.     TO THE MAXIMUM EXTENT PERMITTED BY LAW, IN NO EVENT SHALL
 * BROADCOM OR ITS LICENSORS BE LIABLE FOR (i) CONSEQUENTIAL,
 * INCIDENTAL, SPECIAL, INDIRECT, OR EXEMPLARY DAMAGES WHATSOEVER
 * ARISING OUT OF OR IN ANY WAY RELATING TO YOUR USE OF OR INABILITY
 * TO USE THE SOFTWARE EVEN IF BROADCOM HAS BEEN ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGES; OR (ii) ANY AMOUNT IN EXCESS OF
 * THE AMOUNT ACTUALLY PAID FOR THE SOFTWARE ITSELF OR U.S. $1,
 * WHICHEVER IS GREATER. THESE LIMITATIONS SHALL APPLY NOTWITHSTANDING
 * ANY FAILURE OF ESSENTIAL PURPOSE OF ANY LIMITED REMEDY.$
 */
#include "types.h"
#include "vxWorks.h"
#include "stdio.h"
#include "stdlib.h"
#include "errno.h"
#include "ioLib.h"
#include "dosFsLib.h"
#include "fioLib.h"
#include "blkIo.h"
#include "string.h"
#include "flashFsConfig.h"
#include "flashDrvLib.h"
#include "flashFsLib.h"
#include "errnoLib.h"
#include "config.h"
BLK_DEV         flashBlkDev;
int             flashDosFormat = 0;
int             flashBootSize = 1024*1024;
int             flashFsSize = 1;
int             flashFsSectorStart = 0; /* 5 for A1 */
int             flash_boot_start  = 0x7f00000; /* 0x0 for A1 */
int             flash_nvram_start = 0x7f00000; 
static device_t        flashFsLibXbdDev = 0;
extern device_t        xbdBlkDevCreate (BLK_DEV *bd, const char *name);
DOS_VOLUME_DESC_ID     flashDosVolDesc = 0;
int             flashFsVerbose = 0;
/*
 * CFE partition table
 */
#define PTABLE_MAGIC           0x5054424C /* 'PTBL' (big-endian) */
#define PTABLE_MAGIC_LE        0x4C425450 /* 'PTBL' (little-endian) */
#define PTABLE_PNAME_MAX       16
#define PTABLE_MAX_PARTITIONS  8
typedef struct partition_s {
    char            name[PTABLE_PNAME_MAX];
    unsigned int    offset;
    unsigned int    size;
    unsigned int    type;
    unsigned int    flags;
} partition_t;
typedef struct ptable_s {
    unsigned int    magic;
    unsigned int    version;
    unsigned int    chksum;
    unsigned int    reserved;
    partition_t     part[PTABLE_MAX_PARTITIONS];
} ptable_t;
STATUS
flashFsCheckPtable(ptable_t *ptbl, const char *pname,
                   int *psize, int *poffset)
{
        unsigned int    chksum, u32, *p32;
        int             i, swapped = 0;
        if (ptbl->magic == PTABLE_MAGIC_LE) {
                swapped = 1;
        }
        else if (ptbl->magic != PTABLE_MAGIC) {
                return ERROR;
        }
        chksum = 0;
        p32 = (unsigned int*)ptbl;
        for (i = 0; i < sizeof(ptable_t)/4; i++) {
                chksum ^= p32[i];
                if (swapped) {
                        swab((char*)&p32[i], (char*)&u32, 4);
                        p32[i] = u32;
                }
        }
        if (chksum != 0) {
                return ERROR;
        }
        for (i = 0; i < PTABLE_MAX_PARTITIONS && ptbl->part[i].size; i++) {
            /*
             * We consider the boot partition to span the all partitions
             * up to the first VxWorks compatible filesystem.
             */
            if (strcmp(ptbl->part[i].name, pname) == 0) {
                *psize = ptbl->part[i].size;
                *poffset = ptbl->part[i].offset;
                return OK;
            }
        }
        return ERROR;
}
STATUS
flashFsGetPhys(int blkNum, int *sectorNum, int *offset)
{
    int		sect;
    if (blkNum >= FLASH_FS_SIZE_BLOCKS)
	return (ERROR);
    sect = blkNum / FLASH_FS_BLOCK_PER_SECTOR;
    sect += flashFsSectorStart;
    if ((flashFsSectorStart < FLASH_BOOT_START_SECTOR) &&
        (sect >= FLASH_BOOT_START_SECTOR)) {
	/* Skip boot sector */
	sect += FLASH_BOOT_SIZE_SECTORS;
    }
    if ((flashFsSectorStart < FLASH_NVRAM_START_SECTOR) &&
        (sect >= FLASH_NVRAM_START_SECTOR)) {
	/* Skip boot sector */
	sect += FLASH_NVRAM_SIZE_SECTORS;
    }
    *sectorNum = sect;
    *offset = (blkNum % FLASH_FS_BLOCK_PER_SECTOR) * FLASH_FS_BLOCK_SIZE;
    if (flashFsVerbose > 2)
	printf("flashFsGetPhys(): blkNum = %d, "
	       "*sectorNum = %d, *offset = 0x%xn",
	       blkNum, *sectorNum, *offset);
    return (OK);
}
STATUS
flashFsBlkRead(BLK_DEV *pDev, int startBlk, int numBlks, char *pBuf)
{
    int             blkIndx, phySectorNum, offset;
    if (flashFsVerbose > 1)
	printf("flashFsBlkRead(): startBlk = %d, numBlks = %dn",
	       startBlk, numBlks);
    for (blkIndx = 0; blkIndx < numBlks; blkIndx++) {
	if (flashFsGetPhys((startBlk + blkIndx), &phySectorNum, &offset) ==
	    ERROR) {
	    if (flashFsVerbose)
		printf("flashFsBlkRead(): flashFsGetPhys() failedn");
	    return (ERROR);
	}
	if (flashBlkRead(phySectorNum, pBuf,
			 offset, FLASH_FS_BLOCK_SIZE) == ERROR) {
	    if (flashFsVerbose)
		printf("flashFsBlkRead(): flashBlkRead() failedn");
	    return (ERROR);
	}
	pBuf += FLASH_FS_BLOCK_SIZE;
    }
    return (OK);
}
STATUS
flashFsBlkWrite(BLK_DEV *pDev, int startBlk, int numBlks, char *pBuf)
{
    int             blkIndx, phySectorNum, offset;
    if (flashFsVerbose > 1)
	printf("flashFsBlkWrite(): startBlk = %d, numBlks = %dn",
	       startBlk, numBlks);
    for (blkIndx = 0; blkIndx < numBlks; blkIndx++) {
	if (flashFsGetPhys((startBlk + blkIndx), &phySectorNum, &offset) ==
	    ERROR) {
	    printf("flashFsBlkWrite(): flashFsGetPhys() failedn");
	    return (ERROR);
	}
	if (flashBlkWrite(phySectorNum, pBuf,
			  offset, FLASH_FS_BLOCK_SIZE) == ERROR) {
	    printf("flashFsBlkWrite(): flashBlkWrite() failedn");
	    return (ERROR);
	}
	pBuf += FLASH_FS_BLOCK_SIZE;
    }
    return (OK);
}
STATUS
flashSync(void)
{
    int             flashFd = 0;
    STATUS          rc;
    if ((flashFd = open(FLASH_FS_NAME, O_RDWR, 0666)) == ERROR) {
	printf("flashSync(): open() failedn");
    }
    rc = ioctl(flashFd, FLASH_FS_SYNC, 0);
    close(flashFd);
    return rc;
}
STATUS
flashFsIoctl(BLK_DEV *pDev, int funcCode, int arg)
{
    int			sectorAfterBoot;
    if (flashFsVerbose > 1)
	printf("flashFsBlkIoctl(): calledn");
    switch (funcCode) {
    case FIODISKFORMAT:
	/* Clear flashDrvLib's cached sector */
	if (flashDrvLibInit() == ERROR) {
	    printf("flashFsLibInit(): flashDrvLibInit() failedn");
	    return (ERROR);
	}
	/* From beginning of flash to beginning of Boot Area */
	if (flashEraseBank(0, FLASH_BOOT_START_SECTOR) == ERROR) {
	    return (ERROR);
	}
	sectorAfterBoot = FLASH_BOOT_START_SECTOR + FLASH_BOOT_SIZE_SECTORS;
	/* From end of Boot Area to end of flash */
	if (flashEraseBank(sectorAfterBoot,
			   FLASH_SIZE_SECTORS - sectorAfterBoot) == ERROR) {
	    return (ERROR);
	}
	break;
    case FLASH_FS_SYNC:
	flashSyncFilesystem();
	break;
    default:
	errnoSet(S_ioLib_UNKNOWN_REQUEST);
	return (ERROR);
	break;
    }
    return (OK);
}
int
tstFlashFile(void)
{
    int             fh;
    char            buff[20];
    printf("creatingn");
    fh = creat("myfile", O_RDWR);
    if (fh < 0) {
	printf("tstFlashFile(): create() failedn");
	return (ERROR);
    }
    printf("writingn");
    write(fh, buff, 10);
    printf("closingn");
    close(fh);
    return (0);
}
int
tstFlashFile_1(void)
{
    int             fh;
    char            buff[40];
    printf("openingn");
    fh = open("myfile", O_RDWR, 0664);
    if (fh < 0) {
	printf("tstFlashFile_1(): open() failedn");
	return (ERROR);
    }
    printf("writingn");
    write(fh, buff, 10);
    printf("writingn");
    write(fh, buff, 23);
    printf("closingn");
    close(fh);
    return (0);
}
STATUS
flashFsLibInit(void)
{
    int         bootSize, bootOffset;
    int         fsSize, fsOffset, tmp;
    /* 
     * We are considered initialized once flashDosVolDesc is non-NULL.
     */
    if (flashDosVolDesc) {
	return OK;
    }
    if (flashDrvLibInit() == ERROR) {
	printf("flashFsLibInit(): flashDrvLibInit() failedn");
	return (ERROR);
    }
    flash_boot_start = 0x7f00000;
    /* Align with flash sector */
    flash_nvram_start = flash_boot_start - 
                        ((FLASH_NVRAM_SIZE + (FLASH_SECTOR_SIZE - 1)) / 
                         FLASH_SECTOR_SIZE);
    /* Assume boot sector to be 1MB initially. */
    flashBootSize = 1024*1024; 
    bootOffset = FLASH_BOOT_START;
    /* Assume using enire flash */
    flashFsSize = flashSize - flashBootSize - FLASH_NVRAM_SIZE;
    /* 
     * Set up BLK DEV structure
     */
    flashBlkDev.bd_blkRd = flashFsBlkRead;
    flashBlkDev.bd_blkWrt = flashFsBlkWrite;
    flashBlkDev.bd_ioctl = flashFsIoctl;
    flashBlkDev.bd_reset = NULL;
    flashBlkDev.bd_statusChk = NULL;
    flashBlkDev.bd_removable = FALSE;
    flashBlkDev.bd_nBlocks = FLASH_FS_SIZE_BLOCKS + 1;
    flashBlkDev.bd_bytesPerBlk = FLASH_FS_BLOCK_SIZE;
    flashBlkDev.bd_blksPerTrack = 1;
    flashBlkDev.bd_nHeads = 1;
    flashBlkDev.bd_retry = 1;
    flashBlkDev.bd_mode = O_RDWR;
    flashBlkDev.bd_readyChanged = FALSE;
    if (flashFsVerbose) {
	printf("flashFsLibInit: Initializingn");
    }
    {
        char fsmName[12];
        sprintf (fsmName, "%s:0", FLASH_FS_NAME); /* Create name for mapping. */
        fsmNameInstall (fsmName, FLASH_FS_NAME);  /* Install name mapping. */
        if ((flashFsLibXbdDev = 
             xbdBlkDevCreate(&flashBlkDev, FLASH_FS_NAME)) == NULLDEV) {
            printf("flashFsLibInit: failed to created xdb device !!n");
            return (ERROR);
        }
        if (dosFsDevCreate(FLASH_FS_NAME, flashFsLibXbdDev, 
                           DOSFS_DEFAULT_MAX_FILES, DOS_CHK_NONE)) {
            printf("Failed to create DOS file device n");
            return (ERROR);
        }
        flashDosVolDesc = dosFsVolDescGet(FLASH_FS_NAME, NULL);
        if (flashDosVolDesc == NULL) {
            if (flashFsVerbose) {
                printf("nflashFsLibInit: first time initialization...n");
            }
            dosFsVolFormat(FLASH_FS_NAME, DOS_OPT_DEFAULT, NULL);
            flashDosVolDesc = dosFsVolDescGet(FLASH_FS_NAME, NULL);
            if (flashDosVolDesc == NULL) {
                printf("Failed to Format DOS file device n");
                return (ERROR);
            }
        }
        
        if (flashFsVerbose) {
            dosFsShow(FLASH_FS_NAME, DOS_CHK_VERB_2);
        }
    }
    flashFsSync();
    return OK;
}
STATUS
flashFsSync(void)
{
/*    if (flashDosVolDesc) { */
	if (flashFsVerbose) {
	    printf("flashFsSync(): Syncing...");
	}
	flashSyncFilesystem();
	if (flashFsVerbose) {
	    printf("donen");
	}
/*    } */
    return OK;
}

						