mirror of
https://github.com/wiidev/usbloadergx.git
synced 2024-11-25 20:56:53 +01:00
236 lines
8.2 KiB
C
236 lines
8.2 KiB
C
/**
|
|
* mst.c - Multi sector fixup handling code. Originated from the Linux-NTFS project.
|
|
*
|
|
* Copyright (c) 2000-2004 Anton Altaparmakov
|
|
* Copyright (c) 2006-2009 Szabolcs Szakacsits
|
|
*
|
|
* This program/include file 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 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program/include file 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 this program (in the main directory of the NTFS-3G
|
|
* distribution in the file COPYING); if not, write to the Free Software
|
|
* Foundation,Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#ifdef HAVE_ERRNO_H
|
|
#include <errno.h>
|
|
#endif
|
|
|
|
#include "mst.h"
|
|
#include "logging.h"
|
|
|
|
/**
|
|
* ntfs_mst_post_read_fixup - deprotect multi sector transfer protected data
|
|
* @b: pointer to the data to deprotect
|
|
* @size: size in bytes of @b
|
|
*
|
|
* Perform the necessary post read multi sector transfer fixups and detect the
|
|
* presence of incomplete multi sector transfers. - In that case, overwrite the
|
|
* magic of the ntfs record header being processed with "BAAD" (in memory only!)
|
|
* and abort processing.
|
|
*
|
|
* Return 0 on success and -1 on error, with errno set to the error code. The
|
|
* following error codes are defined:
|
|
* EINVAL Invalid arguments or invalid NTFS record in buffer @b.
|
|
* EIO Multi sector transfer error was detected. Magic of the NTFS
|
|
* record in @b will have been set to "BAAD".
|
|
*/
|
|
int ntfs_mst_post_read_fixup(NTFS_RECORD *b, const u32 size)
|
|
{
|
|
u16 usa_ofs, usa_count, usn;
|
|
u16 *usa_pos, *data_pos;
|
|
|
|
ntfs_log_trace("Entering\n");
|
|
|
|
/* Setup the variables. */
|
|
usa_ofs = le16_to_cpu(b->usa_ofs);
|
|
/* Decrement usa_count to get number of fixups. */
|
|
usa_count = le16_to_cpu(b->usa_count) - 1;
|
|
/* Size and alignment checks. */
|
|
if (size & (NTFS_BLOCK_SIZE - 1) || usa_ofs & 1 || (u32) (usa_ofs + (usa_count * 2)) > size || (size
|
|
>> NTFS_BLOCK_SIZE_BITS) != usa_count)
|
|
{
|
|
errno = EINVAL;
|
|
ntfs_log_perror("%s: magic: 0x%08x size: %d usa_ofs: %d "
|
|
"usa_count: %d", __FUNCTION__, *(le32 *)b,
|
|
size, usa_ofs, usa_count);
|
|
return -1;
|
|
}
|
|
/* Position of usn in update sequence array. */
|
|
usa_pos = (u16*) b + usa_ofs / sizeof(u16);
|
|
/*
|
|
* The update sequence number which has to be equal to each of the
|
|
* u16 values before they are fixed up. Note no need to care for
|
|
* endianness since we are comparing and moving data for on disk
|
|
* structures which means the data is consistent. - If it is
|
|
* consistency the wrong endianness it doesn't make any difference.
|
|
*/
|
|
usn = *usa_pos;
|
|
/*
|
|
* Position in protected data of first u16 that needs fixing up.
|
|
*/
|
|
data_pos = (u16*) b + NTFS_BLOCK_SIZE / sizeof(u16) - 1;
|
|
/*
|
|
* Check for incomplete multi sector transfer(s).
|
|
*/
|
|
while (usa_count--)
|
|
{
|
|
if (*data_pos != usn)
|
|
{
|
|
/*
|
|
* Incomplete multi sector transfer detected! )-:
|
|
* Set the magic to "BAAD" and return failure.
|
|
* Note that magic_BAAD is already converted to le32.
|
|
*/
|
|
errno = EIO;
|
|
ntfs_log_perror("Incomplete multi-sector transfer: "
|
|
"magic: 0x%08x size: %d usa_ofs: %d usa_count:"
|
|
" %d data: %d usn: %d", *(le32 *)b, size,
|
|
usa_ofs, usa_count, *data_pos, usn);
|
|
b->magic = magic_BAAD;
|
|
return -1;
|
|
}
|
|
data_pos += NTFS_BLOCK_SIZE / sizeof(u16);
|
|
}
|
|
/* Re-setup the variables. */
|
|
usa_count = le16_to_cpu(b->usa_count) - 1;
|
|
data_pos = (u16*) b + NTFS_BLOCK_SIZE / sizeof(u16) - 1;
|
|
/* Fixup all sectors. */
|
|
while (usa_count--)
|
|
{
|
|
/*
|
|
* Increment position in usa and restore original data from
|
|
* the usa into the data buffer.
|
|
*/
|
|
*data_pos = *(++usa_pos);
|
|
/* Increment position in data as well. */
|
|
data_pos += NTFS_BLOCK_SIZE / sizeof(u16);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ntfs_mst_pre_write_fixup - apply multi sector transfer protection
|
|
* @b: pointer to the data to protect
|
|
* @size: size in bytes of @b
|
|
*
|
|
* Perform the necessary pre write multi sector transfer fixup on the data
|
|
* pointer to by @b of @size.
|
|
*
|
|
* Return 0 if fixups applied successfully or -1 if no fixups were performed
|
|
* due to errors. In that case errno i set to the error code (EINVAL).
|
|
*
|
|
* NOTE: We consider the absence / invalidity of an update sequence array to
|
|
* mean error. This means that you have to create a valid update sequence
|
|
* array header in the ntfs record before calling this function, otherwise it
|
|
* will fail (the header needs to contain the position of the update sequence
|
|
* array together with the number of elements in the array). You also need to
|
|
* initialise the update sequence number before calling this function
|
|
* otherwise a random word will be used (whatever was in the record at that
|
|
* position at that time).
|
|
*/
|
|
int ntfs_mst_pre_write_fixup(NTFS_RECORD *b, const u32 size)
|
|
{
|
|
u16 usa_ofs, usa_count, usn;
|
|
u16 *usa_pos, *data_pos;
|
|
|
|
ntfs_log_trace("Entering\n");
|
|
|
|
/* Sanity check + only fixup if it makes sense. */
|
|
if (!b || ntfs_is_baad_record(b->magic) || ntfs_is_hole_record(b->magic))
|
|
{
|
|
errno = EINVAL;
|
|
ntfs_log_perror("%s: bad argument", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
/* Setup the variables. */
|
|
usa_ofs = le16_to_cpu(b->usa_ofs);
|
|
/* Decrement usa_count to get number of fixups. */
|
|
usa_count = le16_to_cpu(b->usa_count) - 1;
|
|
/* Size and alignment checks. */
|
|
if (size & (NTFS_BLOCK_SIZE - 1) || usa_ofs & 1 || (u32) (usa_ofs + (usa_count * 2)) > size || (size
|
|
>> NTFS_BLOCK_SIZE_BITS) != usa_count)
|
|
{
|
|
errno = EINVAL;
|
|
ntfs_log_perror("%s", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
/* Position of usn in update sequence array. */
|
|
usa_pos = (u16*) ((u8*) b + usa_ofs);
|
|
/*
|
|
* Cyclically increment the update sequence number
|
|
* (skipping 0 and -1, i.e. 0xffff).
|
|
*/
|
|
usn = le16_to_cpup(usa_pos) + 1;
|
|
if (usn == 0xffff || !usn) usn = 1;
|
|
usn = cpu_to_le16(usn);
|
|
*usa_pos = usn;
|
|
/* Position in data of first u16 that needs fixing up. */
|
|
data_pos = (u16*) b + NTFS_BLOCK_SIZE / sizeof(u16) - 1;
|
|
/* Fixup all sectors. */
|
|
while (usa_count--)
|
|
{
|
|
/*
|
|
* Increment the position in the usa and save the
|
|
* original data from the data buffer into the usa.
|
|
*/
|
|
*(++usa_pos) = *data_pos;
|
|
/* Apply fixup to data. */
|
|
*data_pos = usn;
|
|
/* Increment position in data as well. */
|
|
data_pos += NTFS_BLOCK_SIZE / sizeof(u16);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ntfs_mst_post_write_fixup - deprotect multi sector transfer protected data
|
|
* @b: pointer to the data to deprotect
|
|
*
|
|
* Perform the necessary post write multi sector transfer fixup, not checking
|
|
* for any errors, because we assume we have just used
|
|
* ntfs_mst_pre_write_fixup(), thus the data will be fine or we would never
|
|
* have gotten here.
|
|
*/
|
|
void ntfs_mst_post_write_fixup(NTFS_RECORD *b)
|
|
{
|
|
u16 *usa_pos, *data_pos;
|
|
|
|
u16 usa_ofs = le16_to_cpu(b->usa_ofs);
|
|
u16 usa_count = le16_to_cpu(b->usa_count) - 1;
|
|
|
|
ntfs_log_trace("Entering\n");
|
|
|
|
/* Position of usn in update sequence array. */
|
|
usa_pos = (u16*) b + usa_ofs / sizeof(u16);
|
|
|
|
/* Position in protected data of first u16 that needs fixing up. */
|
|
data_pos = (u16*) b + NTFS_BLOCK_SIZE / sizeof(u16) - 1;
|
|
|
|
/* Fixup all sectors. */
|
|
while (usa_count--)
|
|
{
|
|
/*
|
|
* Increment position in usa and restore original data from
|
|
* the usa into the data buffer.
|
|
*/
|
|
*data_pos = *(++usa_pos);
|
|
|
|
/* Increment position in data as well. */
|
|
data_pos += NTFS_BLOCK_SIZE / sizeof(u16);
|
|
}
|
|
}
|
|
|