diff options
Diffstat (limited to 'roms/u-boot/disk/part_iso.c')
-rw-r--r-- | roms/u-boot/disk/part_iso.c | 244 |
1 files changed, 244 insertions, 0 deletions
diff --git a/roms/u-boot/disk/part_iso.c b/roms/u-boot/disk/part_iso.c new file mode 100644 index 000000000..822f2c4d9 --- /dev/null +++ b/roms/u-boot/disk/part_iso.c @@ -0,0 +1,244 @@ +// SPDX-License-Identifier: GPL-2.0+ +/* + * (C) Copyright 2001 + * Denis Peter, MPL AG Switzerland, d.peter@mpl.ch. + */ + +#include <common.h> +#include <blk.h> +#include <command.h> +#include <part.h> +#include <asm/cache.h> +#include <asm/unaligned.h> +#include "part_iso.h" + +#ifdef CONFIG_HAVE_BLOCK_DEVICE + +/* #define ISO_PART_DEBUG */ + +#ifdef ISO_PART_DEBUG +#define PRINTF(fmt,args...) printf (fmt ,##args) +#else +#define PRINTF(fmt,args...) +#endif + +/* enable this if CDs are written with the PowerPC Platform ID */ +#undef CHECK_FOR_POWERPC_PLATTFORM +#define CD_SECTSIZE 2048 + +static unsigned char tmpbuf[CD_SECTSIZE] __aligned(ARCH_DMA_MINALIGN); + +unsigned long iso_dread(struct blk_desc *block_dev, lbaint_t start, + lbaint_t blkcnt, void *buffer) +{ + unsigned long ret; + + if (block_dev->blksz == 512) { + /* Convert from 2048 to 512 sector size */ + start *= 4; + blkcnt *= 4; + } + + ret = blk_dread(block_dev, start, blkcnt, buffer); + + if (block_dev->blksz == 512) + ret /= 4; + + return ret; +} + +/* only boot records will be listed as valid partitions */ +int part_get_info_iso_verb(struct blk_desc *dev_desc, int part_num, + struct disk_partition *info, int verb) +{ + int i,offset,entry_num; + unsigned short *chksumbuf; + unsigned short chksum; + unsigned long newblkaddr,blkaddr,lastsect,bootaddr; + iso_boot_rec_t *pbr = (iso_boot_rec_t *)tmpbuf; /* boot record */ + iso_pri_rec_t *ppr = (iso_pri_rec_t *)tmpbuf; /* primary desc */ + iso_val_entry_t *pve = (iso_val_entry_t *)tmpbuf; + iso_init_def_entry_t *pide; + + if ((dev_desc->blksz != CD_SECTSIZE) && (dev_desc->blksz != 512)) + return -1; + + /* the first sector (sector 0x10) must be a primary volume desc */ + blkaddr=PVD_OFFSET; + if (iso_dread(dev_desc, PVD_OFFSET, 1, (ulong *)tmpbuf) != 1) + return -1; + if(ppr->desctype!=0x01) { + if(verb) + printf ("** First descriptor is NOT a primary desc on %d:%d **\n", + dev_desc->devnum, part_num); + return (-1); + } + if(strncmp((char *)ppr->stand_ident,"CD001",5)!=0) { + if(verb) + printf ("** Wrong ISO Ident: %s on %d:%d **\n", + ppr->stand_ident, dev_desc->devnum, part_num); + return (-1); + } + lastsect = le32_to_cpu(ppr->firstsek_LEpathtab1_LE); + /* assuming same block size for all entries */ + info->blksz = be16_to_cpu(ppr->secsize_BE); + PRINTF(" Lastsect:%08lx\n",lastsect); + for(i=blkaddr;i<lastsect;i++) { + PRINTF("Reading block %d\n", i); + if (iso_dread(dev_desc, i, 1, (ulong *)tmpbuf) != 1) + return -1; + if(ppr->desctype==0x00) + break; /* boot entry found */ + if(ppr->desctype==0xff) { + if(verb) + printf ("** No valid boot catalog found on %d:%d **\n", + dev_desc->devnum, part_num); + return (-1); + } + } + /* boot entry found */ + if(strncmp(pbr->ident_str,"EL TORITO SPECIFICATION",23)!=0) { + if(verb) + printf ("** Wrong El Torito ident: %s on %d:%d **\n", + pbr->ident_str, dev_desc->devnum, part_num); + return (-1); + } + bootaddr = get_unaligned_le32(pbr->pointer); + PRINTF(" Boot Entry at: %08lX\n",bootaddr); + if (iso_dread(dev_desc, bootaddr, 1, (ulong *)tmpbuf) != 1) { + if(verb) + printf ("** Can't read Boot Entry at %lX on %d:%d **\n", + bootaddr, dev_desc->devnum, part_num); + return (-1); + } + chksum=0; + chksumbuf = (unsigned short *)tmpbuf; + for(i=0;i<0x10;i++) + chksum += le16_to_cpu(chksumbuf[i]); + if(chksum!=0) { + if(verb) + printf("** Checksum Error in booting catalog validation entry on %d:%d **\n", + dev_desc->devnum, part_num); + return (-1); + } + if((pve->key[0]!=0x55)||(pve->key[1]!=0xAA)) { + if(verb) + printf ("** Key 0x55 0xAA error on %d:%d **\n", + dev_desc->devnum, part_num); + return(-1); + } +#ifdef CHECK_FOR_POWERPC_PLATTFORM + if(pve->platform!=0x01) { + if(verb) + printf ("** No PowerPC platform CD on %d:%d **\n", + dev_desc->devnum, part_num); + return(-1); + } +#endif + /* the validation entry seems to be ok, now search the "partition" */ + entry_num=1; + offset=0x20; + strcpy((char *)info->type, "U-Boot"); + part_set_generic_name(dev_desc, part_num, (char *)info->name); + /* the bootcatalog (including validation Entry) is limited to 2048Bytes + * (63 boot entries + validation entry) */ + while(offset<2048) { + pide=(iso_init_def_entry_t *)&tmpbuf[offset]; + if ((pide->boot_ind==0x88) || + (pide->boot_ind==0x00)) { /* Header Id for default Sections Entries */ + if(entry_num==part_num) { /* part found */ + goto found; + } + entry_num++; /* count partitions Entries (boot and non bootables */ + offset+=0x20; + continue; + } + if ((pide->boot_ind==0x90) || /* Section Header Entry */ + (pide->boot_ind==0x91) || /* Section Header Entry (last) */ + (pide->boot_ind==0x44)) { /* Extension Indicator */ + offset+=0x20; /* skip unused entries */ + } + else { + if(verb) + printf ("** Partition %d not found on device %d **\n", + part_num, dev_desc->devnum); + return(-1); + } + } + /* if we reach this point entire sector has been + * searched w/o succsess */ + if(verb) + printf ("** Partition %d not found on device %d **\n", + part_num, dev_desc->devnum); + return(-1); +found: + if(pide->boot_ind!=0x88) { + if(verb) + printf("** Partition %d is not bootable on device %d **\n", + part_num, dev_desc->devnum); + return (-1); + } + switch(pide->boot_media) { + case 0x00: /* no emulation */ + info->size = get_unaligned_le16(pide->sec_cnt)>>2; + break; + case 0x01: info->size=2400>>2; break; /* 1.2MByte Floppy */ + case 0x02: info->size=2880>>2; break; /* 1.44MByte Floppy */ + case 0x03: info->size=5760>>2; break; /* 2.88MByte Floppy */ + case 0x04: info->size=2880>>2; break; /* dummy (HD Emulation) */ + default: info->size=0; break; + } + newblkaddr = get_unaligned_le32(pide->rel_block_addr); + info->start=newblkaddr; + + if (dev_desc->blksz == 512) { + info->size *= 4; + info->start *= 4; + info->blksz = 512; + } + + PRINTF(" part %d found @ %lx size %lx\n",part_num,info->start,info->size); + return 0; +} + +static int part_get_info_iso(struct blk_desc *dev_desc, int part_num, + struct disk_partition *info) +{ + return part_get_info_iso_verb(dev_desc, part_num, info, 0); +} + +static void part_print_iso(struct blk_desc *dev_desc) +{ + struct disk_partition info; + int i; + + if (part_get_info_iso_verb(dev_desc, 1, &info, 0) == -1) { + printf("** No boot partition found on device %d **\n", + dev_desc->devnum); + return; + } + printf("Part Start Sect x Size Type\n"); + i=1; + do { + printf(" %2d " LBAFU " " LBAFU " %6ld %.32s\n", + i, info.start, info.size, info.blksz, info.type); + i++; + } while (part_get_info_iso_verb(dev_desc, i, &info, 0) != -1); +} + +static int part_test_iso(struct blk_desc *dev_desc) +{ + struct disk_partition info; + + return part_get_info_iso_verb(dev_desc, 1, &info, 0); +} + +U_BOOT_PART_TYPE(iso) = { + .name = "ISO", + .part_type = PART_TYPE_ISO, + .max_entries = ISO_ENTRY_NUMBERS, + .get_info = part_get_info_iso, + .print = part_print_iso, + .test = part_test_iso, +}; +#endif |