mirror of https://github.com/ventoy/Ventoy
You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
135 lines
3.1 KiB
C
135 lines
3.1 KiB
C
/*
|
|
* Copyright (C) 2012 Michael Brown <mbrown@fensystems.co.uk>.
|
|
*
|
|
* This program 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 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; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
|
* 02110-1301, USA.
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
*
|
|
* CPIO archives
|
|
*
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include "wimboot.h"
|
|
#include "cpio.h"
|
|
|
|
/**
|
|
* Align CPIO length to nearest dword
|
|
*
|
|
* @v len Length
|
|
* @ret len Aligned length
|
|
*/
|
|
static size_t cpio_align ( size_t len ) {
|
|
return ( ( len + 0x03 ) & ~0x03 );
|
|
}
|
|
|
|
/**
|
|
* Parse CPIO field value
|
|
*
|
|
* @v field ASCII field
|
|
* @ret value Field value
|
|
*/
|
|
static unsigned long cpio_value ( const char *field ) {
|
|
char buf[9];
|
|
|
|
memcpy ( buf, field, ( sizeof ( buf ) - 1 ) );
|
|
buf[ sizeof ( buf ) - 1 ] = '\0';
|
|
return strtoul ( buf, NULL, 16 );
|
|
}
|
|
|
|
/**
|
|
* Extract files from CPIO archive
|
|
*
|
|
* @v data CPIO archive
|
|
* @v len Maximum length of CPIO archive
|
|
* @v file File handler
|
|
* @ret rc Return status code
|
|
*/
|
|
int cpio_extract ( void *data, size_t len,
|
|
int ( * file ) ( const char *name, void *data,
|
|
size_t len ) ) {
|
|
const struct cpio_header *cpio;
|
|
const uint32_t *pad;
|
|
const char *file_name;
|
|
void *file_data;
|
|
size_t file_name_len;
|
|
size_t file_len;
|
|
size_t cpio_len;
|
|
int rc;
|
|
|
|
while ( 1 ) {
|
|
|
|
/* Skip over any padding */
|
|
while ( len >= sizeof ( *pad ) ) {
|
|
pad = data;
|
|
if ( *pad )
|
|
break;
|
|
data += sizeof ( *pad );
|
|
len -= sizeof ( *pad );
|
|
}
|
|
|
|
/* Stop if we have reached the end of the archive */
|
|
if ( ! len )
|
|
return 0;
|
|
|
|
/* Sanity check */
|
|
if ( len < sizeof ( *cpio ) ) {
|
|
DBG ( "Truncated CPIO header\n" );
|
|
return -1;
|
|
}
|
|
cpio = data;
|
|
|
|
/* Check magic */
|
|
if ( memcmp ( cpio->c_magic, CPIO_MAGIC,
|
|
sizeof ( cpio->c_magic ) ) != 0 ) {
|
|
DBG ( "Bad CPIO magic\n" );
|
|
return -1;
|
|
}
|
|
|
|
/* Extract file parameters */
|
|
file_name = ( ( void * ) ( cpio + 1 ) );
|
|
file_name_len = cpio_value ( cpio->c_namesize );
|
|
file_data = ( data + cpio_align ( sizeof ( *cpio ) +
|
|
file_name_len ) );
|
|
file_len = cpio_value ( cpio->c_filesize );
|
|
cpio_len = ( file_data + file_len - data );
|
|
if ( cpio_len < len )
|
|
cpio_len = cpio_align ( cpio_len );
|
|
if ( cpio_len > len ) {
|
|
DBG ( "Truncated CPIO file\n" );
|
|
return -1;
|
|
}
|
|
|
|
/* If we reach the trailer, we're done */
|
|
if ( strcmp ( file_name, CPIO_TRAILER ) == 0 )
|
|
return 0;
|
|
|
|
/* Process file */
|
|
if ( ( rc = file ( file_name, file_data, file_len ) ) != 0 )
|
|
return rc;
|
|
|
|
/* Move to next file */
|
|
data += cpio_len;
|
|
len -= cpio_len;
|
|
}
|
|
}
|