282 lines
9.2 KiB
C
282 lines
9.2 KiB
C
|
/****************************************************************************
|
||
|
* fs/nxffs/nxffs_reformat.c
|
||
|
*
|
||
|
* Copyright (C) 2011 Gregory Nutt. All rights reserved.
|
||
|
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||
|
*
|
||
|
* References: Linux/Documentation/filesystems/romfs.txt
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that the following conditions
|
||
|
* are met:
|
||
|
*
|
||
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer.
|
||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer in
|
||
|
* the documentation and/or other materials provided with the
|
||
|
* distribution.
|
||
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
||
|
* used to endorse or promote products derived from this software
|
||
|
* without specific prior written permission.
|
||
|
*
|
||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Included Files
|
||
|
****************************************************************************/
|
||
|
|
||
|
#include <nuttx/config.h>
|
||
|
|
||
|
#include <string.h>
|
||
|
#include <errno.h>
|
||
|
#include <debug.h>
|
||
|
|
||
|
#include <nuttx/mtd.h>
|
||
|
|
||
|
#include "nxffs.h"
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Pre-processor Definitions
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Private Types
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Public Variables
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Private Functions
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Name: nxffs_format
|
||
|
*
|
||
|
* Description:
|
||
|
* Erase and reformat the entire volume.
|
||
|
*
|
||
|
* Input Parameters:
|
||
|
* volume - Describes the NXFFS volume to be reformatted.
|
||
|
*
|
||
|
* Returned Value:
|
||
|
* Zero on success or a negated errno on a failure. Failures will be
|
||
|
* returned n the case of MTD reported failures o.
|
||
|
* Nothing in the volume data itself will generate errors.
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
|
||
|
static int nxffs_format(FAR struct nxffs_volume_s *volume)
|
||
|
{
|
||
|
FAR uint8_t *blkptr; /* Pointer to next block data */
|
||
|
off_t eblock; /* Erase block number */
|
||
|
off_t lblock; /* Logical block number */
|
||
|
ssize_t nxfrd; /* Number of blocks transferred */
|
||
|
int i;
|
||
|
int ret;
|
||
|
|
||
|
/* Create an image of one properly formatted erase sector */
|
||
|
|
||
|
memset(volume->cache, CONFIG_NXFFS_ERASEDSTATE, volume->geo.erasesize);
|
||
|
for (blkptr = volume->cache, i = 0;
|
||
|
i < volume->blkper;
|
||
|
blkptr += SIZEOF_NXFFS_BLOCK_HDR, i++)
|
||
|
{
|
||
|
FAR struct nxffs_block_s *blkhdr = (FAR struct nxffs_block_s*)blkptr;
|
||
|
memcpy(blkhdr->magic, g_blockmagic, NXFFS_MAGICSIZE);
|
||
|
blkhdr->state = BLOCK_STATE_GOOD;
|
||
|
}
|
||
|
|
||
|
/* Erase and format each erase block */
|
||
|
|
||
|
for (eblock = 0; eblock < volume->geo.neraseblocks; eblock++)
|
||
|
{
|
||
|
/* Erase the block */
|
||
|
|
||
|
ret = MTD_ERASE(volume->mtd, eblock, 1);
|
||
|
if (ret < 0)
|
||
|
{
|
||
|
fdbg("Erase block %d failed: %d\n", eblock, ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/* Write the formatted image to the erase block */
|
||
|
|
||
|
lblock = eblock * volume->blkper;
|
||
|
nxfrd = MTD_BWRITE(volume->mtd, lblock, volume->blkper, volume->cache);
|
||
|
if (nxfrd != volume->blkper)
|
||
|
{
|
||
|
fdbg("Write erase block %d failed: %d\n", alignedblock, nxfrd);
|
||
|
return -EIO;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return OK;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Name: nxffs_badblocks
|
||
|
*
|
||
|
* Description:
|
||
|
* Verify each block and mark improperly erased blocks as bad.
|
||
|
*
|
||
|
* Input Parameters:
|
||
|
* volume - Describes the NXFFS volume to be reformatted.
|
||
|
*
|
||
|
* Returned Value:
|
||
|
* Zero on success or a negated errno on a failure. Failures will be
|
||
|
* returned n the case of MTD reported failures o.
|
||
|
* Nothing in the volume data itself will generate errors.
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
|
||
|
static int nxffs_badblocks(FAR struct nxffs_volume_s *volume)
|
||
|
{
|
||
|
FAR uint8_t *blkptr; /* Pointer to next block data */
|
||
|
FAR uint8_t *datptr; /* Pointer to next data byte */
|
||
|
off_t eblock; /* Erase block number */
|
||
|
off_t lblock; /* Logical block number */
|
||
|
ssize_t nxfrd; /* Number of blocks transferred */
|
||
|
uint16_t blkndx; /* Logical block data index */
|
||
|
bool bad; /* TRUE: block is bad */
|
||
|
bool modified; /* TRUE: The erase block has been modified */
|
||
|
int i;
|
||
|
|
||
|
/* Read and verify each erase block */
|
||
|
|
||
|
for (eblock = 0; eblock < volume->geo.neraseblocks; eblock++)
|
||
|
{
|
||
|
/* Read the entire erase block */
|
||
|
|
||
|
lblock = eblock * volume->blkper;
|
||
|
nxfrd = MTD_BREAD(volume->mtd, lblock, volume->blkper, volume->cache);
|
||
|
if (nxfrd != volume->blkper)
|
||
|
{
|
||
|
fdbg("Read erase block %d failed: %d\n", lblock, nxfrd);
|
||
|
return -EIO;
|
||
|
}
|
||
|
|
||
|
/* Process each logical block */
|
||
|
|
||
|
modified = false;
|
||
|
for (blkptr = volume->cache, i = 0;
|
||
|
i < volume->blkper;
|
||
|
blkptr += SIZEOF_NXFFS_BLOCK_HDR, i++)
|
||
|
{
|
||
|
FAR struct nxffs_block_s *blkhdr = (FAR struct nxffs_block_s*)blkptr;
|
||
|
|
||
|
/* Check block header */
|
||
|
|
||
|
bad = false;
|
||
|
if (memcmp(blkhdr->magic, g_blockmagic, NXFFS_MAGICSIZE) != 0 ||
|
||
|
blkhdr->state == BLOCK_STATE_GOOD)
|
||
|
{
|
||
|
bad = true;;
|
||
|
}
|
||
|
|
||
|
/* Check that block data is erased */
|
||
|
|
||
|
else
|
||
|
{
|
||
|
/* Check every byte in the block payload */
|
||
|
|
||
|
for (blkndx = SIZEOF_NXFFS_BLOCK_HDR, datptr = &blkptr[blkndx];
|
||
|
blkndx < volume->geo.blocksize;
|
||
|
blkndx++)
|
||
|
{
|
||
|
/* If the data byte is not in the erased state, then the block is bad */
|
||
|
|
||
|
uint8_t byte = *datptr++;
|
||
|
if (byte != CONFIG_NXFFS_ERASEDSTATE)
|
||
|
{
|
||
|
bad = true;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* If the block is bad, attempt to re-write the block header indicating
|
||
|
* a bad block (of course, if the block has failed, this may not be
|
||
|
* possible, depending upon failure modes.
|
||
|
*/
|
||
|
|
||
|
if (bad)
|
||
|
{
|
||
|
memcpy(blkhdr->magic, g_blockmagic, NXFFS_MAGICSIZE);
|
||
|
blkhdr->state = BLOCK_STATE_BAD;
|
||
|
modified = true;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* If the erase block was modified, then re-write it */
|
||
|
|
||
|
nxfrd = MTD_BWRITE(volume->mtd, lblock, volume->blkper, volume->cache);
|
||
|
if (nxfrd != volume->blkper)
|
||
|
{
|
||
|
fdbg("Write erase block %d failed: %d\n", alignedblock, nxfrd);
|
||
|
return -EIO;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return OK;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Public Functions
|
||
|
****************************************************************************/
|
||
|
|
||
|
/****************************************************************************
|
||
|
* Name: nxffs_reformat
|
||
|
*
|
||
|
* Description:
|
||
|
* Erase and reformat the entire volume. Verify each block and mark
|
||
|
* improperly erased blocks as bad.
|
||
|
*
|
||
|
* Input Parameters:
|
||
|
* volume - Describes the NXFFS volume to be reformatted.
|
||
|
*
|
||
|
* Returned Value:
|
||
|
* Zero on success or a negated errno on a failure. Failures will be
|
||
|
* returned n the case of MTD reported failures o.
|
||
|
* Nothing in the volume data itself will generate errors.
|
||
|
*
|
||
|
****************************************************************************/
|
||
|
|
||
|
int nxffs_reformat(FAR struct nxffs_volume_s *volume)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
/* Erase and reformat the entire volume */
|
||
|
|
||
|
ret = nxffs_format(volume);
|
||
|
if (ret < 0)
|
||
|
{
|
||
|
fdbg("Failed to reformat the volume: %d\n", -ret);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/* Check for bad blocks */
|
||
|
|
||
|
ret = nxffs_badblocks(volume);
|
||
|
if (ret < 0)
|
||
|
{
|
||
|
fdbg("Bad block check failed: %d\n", -ret);
|
||
|
}
|
||
|
return ret;
|
||
|
}
|