isofs.cpp

PS2游戏硬盘直灌（HDL）的Windows下VC的源代码

/*
 * isofs.c
 * $Id: isofs.c,v 1.7 2004/12/04 10:20:52 b081 Exp $
 *
 * Copyright 2004 Bobi B., [e-mail]
 *
 * This file is part of hdl_dump.
 *
 * hdl_dump 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.
 *
 * hdl_dump 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 hdl_dump; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include <ctype.h>
#include <string.h>
#include "isofs.h"
#include "retcodes.h"
#include "common.h"


#define CDVD_SECT_SIZE 2048


/*
 * pvd == "Primary Volume Descriptor"
 * ptr == "Path Table Record"
 */
static int
isofs_find_pvd_addr (iin_t *iin,
		     u_int64_t *pvd_start_addr,
		     u_int64_t *ptr_start_addr,
		     char system_id [32 + 1],
		     char volume_id [32 + 1])
{
  u_int32_t start_sector = 16;
  const char *data;
  u_int32_t len;
  const unsigned char *buffer;
  int result = iin->read (iin, start_sector, 1, &data, &len);
  buffer = (const unsigned char*) data;

  if (result == OSAL_OK)
    result = memcmp (buffer + 1, "CD001", 5) == 0 ? OSAL_OK : RET_BAD_ISOFS;
  if (result == OSAL_OK)
    {
      if (buffer [0] == 0x01) /* primary volume descriptor set */
	{
	  *pvd_start_addr = start_sector * IIN_SECTOR_SIZE;
	  *ptr_start_addr = (u_int64_t) (buffer [143] << 24 |
					buffer [142] << 16 |
					buffer [141] <<  8 |
					buffer [140] <<  0) * (u_int64_t) CDVD_SECT_SIZE;
	  if (system_id != NULL)
	    {
	      memcpy (system_id, buffer + 8, 32);
	      system_id [32] = '\0';
	      rtrim (system_id);
	    }
	  if (volume_id != NULL)
	    {
	      memcpy (volume_id, buffer + 40, 32);
	      volume_id [32] = '\0';
	      rtrim (volume_id);
	    }
	}
      else
	result = RET_BAD_ISOFS; /* primary volume descriptor set not found */
    }
  return (result);
}


static int
isofs_get_root_addr (iin_t *iin,
		     u_int64_t ptr_start_addr,
		     u_int64_t *root_start_addr)
{
  u_int32_t len;
  const char *data;
  int result = iin->read (iin, (u_int32_t) (ptr_start_addr / IIN_SECTOR_SIZE),
			  1, &data, &len);
  const unsigned char *buffer = (const unsigned char*) data;
  if (result == OSAL_OK)
    {
      int found = 0;
      unsigned long dir_start_addr;
      const unsigned char *p = buffer;
      do
	{
	  int id_len;
	  int ext_len;
	  unsigned short parent_dir;

	  id_len = *p++;
	  if (id_len == 0 ||
	      p > buffer + 2047)
	    break; /* last entry */
	  ext_len = *p++;
	  dir_start_addr = p [3] << 24 | p [2] << 16 | p [1] << 8 | p [0]; p += 4;
	  parent_dir = p [1] << 8 | p [0]; p += 2;
	  if (*p == '\0')
	    { /* root dir? */
	      found = 1;
	      break;
	    }
	  else
	    p += id_len + (id_len % 2); /* skip to next entry */
	}
      while (1);

      if (found)
	*root_start_addr = (u_int64_t) dir_start_addr * CDVD_SECT_SIZE;
      else
	result = RET_BAD_ISOFS; /* root dir not found */
    }
  return (result);
}


static int
isofs_get_file_addr (iin_t *iin,
		     u_int64_t dir_start_addr,
		     const char *file_name,
		     u_int64_t *file_start_addr,
		     u_int64_t *file_length)
{
  u_int32_t file_name_len = strlen (file_name);
  u_int32_t len;
  const char *data;
  int result = iin->read (iin, (u_int32_t) (dir_start_addr / IIN_SECTOR_SIZE),
			  1, &data, &len);
  const unsigned char *buffer = (const unsigned char*) data;
  if (result == OSAL_OK)
    {
      int found = 0;
      unsigned long start_addr, length;
      const unsigned char *p = buffer;
      do
	{
	  int len_dr, len_ext_ar, name_len;
	  const unsigned char *start = p;
	  len_dr = *p++;
	  if (len_dr == 0 ||
	      p > buffer + 2047)
	    break; /* last entry */
	  len_ext_ar = *p++;
	  start_addr = p [3] << 24 | p [2] << 16 | p [1] << 8 | p [0]; p += 8;
	  length = p [3] << 24 | p [2] << 16 | p [1] << 8 | p [0]; p += 8;
	  p += 7; /* recording date/time */
	  ++p; ++p; ++p; p += 4; /* flags, unit size, intereave gap size, volume seq no */
	  name_len = *p++;
	  if (name_len == (int)file_name_len &&
	      memcmp (p, file_name, file_name_len) == 0)
	    { /* found */
	      found = 1;
	      break;
	    }
	  else
	    p = start + len_dr; /* continue to the next file */
	}
      while (1);

      if (found)
	{
	  *file_start_addr = (u_int64_t) start_addr * CDVD_SECT_SIZE;
	  *file_length = length;
	}
      else
	result = RET_NOT_FOUND;
    }
  return (result);
}


static int
parse_config_cnf (char *contents,
		  u_int32_t length,
		  char signature [12 + 1])
{
  int found = 0;
  char *line = contents;
  const char *end = contents + length;
  do
    {
      char *p = line, *start = line;
      while (*p != '\r' && *p != '\n' && p < end) ++p;
      *p = '\0';
      line = p + 1;

      /* expected format: "BOOT2 = cdrom0:\SCES_xxx.xx;1\r\n" */
      p = start;
      if (memcmp (p, "BOOT2", 5) == 0)
	{
	  p += 5; while (*p == ' ' || *p == '\t') ++p;
	  if (*p == '=')
	    {
	      ++p; while (*p == ' ' || *p == '\t') ++ p;
	      if (memcmp (p, "cdrom0:\\", 8) == 0)
		{
		  int len = 0;
		  p += 8;
		  while (*p != ';' && len <= 12)
		    *signature++ = *p++;
		  *signature = '\0';
		  found = 1;
		  break;
		}
	    }
	}
    }
  while (line < end);
  return (found ? OSAL_OK : RET_NOT_FOUND);
}


static int
isofs_parse_config_cnf (iin_t *iin,
			u_int64_t file_start_addr,
			u_int64_t file_length,
			char signature [12 + 1])
{
  u_int32_t len;
  const char *data;
  int result = iin->read (iin, (u_int32_t) (file_start_addr / IIN_SECTOR_SIZE),
			  1, &data, &len);
  if (result == OSAL_OK)
    result = parse_config_cnf ((char*) data, (u_int32_t) file_length, signature);
  return (result);
}


int
isofs_get_ps_cdvd_details (iin_t *iin,
			   char volume_id [32 + 1],
			   char signature [12 + 1])
{
  u_int64_t pvd_start_addr, ptr_start_addr, root_start_addr;
  u_int64_t system_cnf_start_addr, system_cnf_length;
  char system_id [32 + 1];
  int result = isofs_find_pvd_addr (iin, &pvd_start_addr, &ptr_start_addr, system_id, volume_id);
  if (result == OSAL_OK)
    if (strcmp (system_id, "PLAYSTATION") != 0)
      result = RET_NOT_PS_CDVD;

  if (result == OSAL_OK)
    result = isofs_get_root_addr (iin, ptr_start_addr, &root_start_addr);

  if (result == OSAL_OK)
    result = isofs_get_file_addr (iin, root_start_addr, "SYSTEM.CNF;1",
				  &system_cnf_start_addr, &system_cnf_length);

  if (result == OSAL_OK)
    result = isofs_parse_config_cnf (iin, system_cnf_start_addr, system_cnf_length, signature);

  return (result);
}