wok annotate syslinux/stuff/iso2exe/iso9660.c @ rev 17473

syslinux/iso2exe: add 64bits support
author Pascal Bellard <pascal.bellard@slitaz.org>
date Sat Dec 27 17:56:57 2014 +0100 (2014-12-27)
parents 7d300004a3b8
children 054f70cb9bec
rev   line source
pascal@13691 1 #include <sys/types.h>
pascal@13691 2 #include <fcntl.h>
pascal@13691 3 #include <stdio.h>
pascal@13691 4 #include "iso9660.h"
pascal@13691 5 #define __ROCKRIDGE
pascal@17473 6 #asm
pascal@17473 7 use16 86
pascal@17473 8 #endasm
pascal@13691 9
pascal@13691 10 char *isofilename;
pascal@13691 11 unsigned long isofileofs, isofilesize;
pascal@13691 12 unsigned short isofilemod;
pascal@13691 13 int isofd;
pascal@13691 14
pascal@13691 15 #define SECTORSZ 2048
pascal@13691 16 #define SECTORBITS 11
pascal@13691 17 static char buffer[SECTORSZ];
pascal@13691 18
pascal@13691 19 static int readsector(unsigned long offset)
pascal@13691 20 {
pascal@13691 21 return (lseek(isofd, offset, SEEK_SET) != -1
pascal@13691 22 && read(isofd, buffer, SECTORSZ) == SECTORSZ);
pascal@13691 23 }
pascal@13691 24
pascal@13691 25 int isoread(char *data, unsigned size)
pascal@13691 26 {
pascal@13691 27 int get, n;
pascal@13691 28
pascal@13691 29 if (size > isofilesize)
pascal@13691 30 size = isofilesize;
pascal@13691 31 if (lseek(isofd, isofileofs, SEEK_SET) == -1)
pascal@13691 32 return -1;
pascal@13691 33 for (get = size; get; get -= n, data += n) {
pascal@13691 34 n = read(isofd,data,get);
pascal@13691 35 if (n < 0)
pascal@13691 36 return n;
pascal@13691 37 if (n == 0)
pascal@13691 38 break;
pascal@13691 39 isofileofs += n;
pascal@13691 40 isofilesize -= n;
pascal@13691 41 }
pascal@13691 42 return size - get;
pascal@13691 43 }
pascal@13691 44
pascal@13691 45 static unsigned long isodirofs, isodirsize;
pascal@13691 46 int isoreset(char *name)
pascal@13691 47 {
pascal@13691 48 if (name)
pascal@13691 49 isofd = open(name, O_RDONLY);
pascal@13691 50 if (!readsector(16UL * 2048) || strncmp(buffer+1,"CD001",5))
pascal@13691 51 return -1;
pascal@13691 52 isodirofs = * (unsigned long *) (buffer + 0x9E);
pascal@13691 53 isodirofs <<= SECTORBITS;
pascal@13691 54 isodirsize = * (unsigned long *) (buffer + 0xA6);
pascal@13691 55 return 0;
pascal@13691 56 }
pascal@13691 57
pascal@13691 58 int isoreaddir(int restart)
pascal@13691 59 {
pascal@13691 60 static unsigned long pos, dirofs, dirsize;
pascal@13691 61 static char dots[] = "..";
pascal@13691 62 int size, n;
pascal@13691 63 #ifdef __ROCKRIDGE
pascal@13691 64 char *endname;
pascal@13691 65 #endif
pascal@13691 66
pascal@13691 67 if (restart) {
pascal@13691 68 dirofs = isodirofs;
pascal@13691 69 dirsize = isodirsize;
pascal@13691 70 pos = SECTORSZ;
pascal@13691 71 }
pascal@13691 72 if (pos >= SECTORSZ) {
pascal@13691 73 if (dirsize < SECTORSZ) return -1;
pascal@13691 74 readsector(dirofs);
pascal@13691 75 dirofs += SECTORSZ;
pascal@13691 76 dirsize -= SECTORSZ;
pascal@13691 77 pos = 0;
pascal@13691 78 }
pascal@13691 79 size = * (short *) (buffer + pos);
pascal@13691 80 if (size == 0)
pascal@13691 81 return -1;
pascal@13691 82 isofileofs = (* (unsigned long *) (buffer + pos + 2)) << SECTORBITS;
pascal@13691 83 isofilesize = * (unsigned long *) (buffer + pos + 10);
pascal@13691 84 isofilemod = (buffer[pos + 25] & 2) ? 0040755 : 0100755;
pascal@13691 85 #ifdef __ROCKRIDGE
pascal@13691 86 endname = NULL;
pascal@13691 87 n = (buffer[pos + 32] + pos + 34) & -2;
pascal@13691 88 do {
pascal@13691 89 int len = buffer[n + 2];
pascal@13691 90 switch (* (short *) (buffer + n)) {
pascal@13691 91 case 0x4D4E: // NM
pascal@13691 92 isofilename = buffer + n + 5;
pascal@13691 93 endname = buffer + n + len;
pascal@13691 94 break;
pascal@13691 95 case 0x5850: // PX
pascal@13691 96 isofilemod = * (short *) (buffer + n + 4);
pascal@13691 97 break;
pascal@13691 98 }
pascal@13691 99 n += len;
pascal@13691 100 }
pascal@13691 101 while (n + 2 < pos + size);
pascal@13691 102 if (endname)
pascal@13691 103 *endname = 0;
pascal@13691 104 else
pascal@13691 105 #endif
pascal@13691 106 {
pascal@13691 107 isofilename = buffer + pos + 33;
pascal@13691 108 switch (* (short *) (isofilename - 1)) {
pascal@13691 109 case 0x0101:
pascal@13691 110 isofilename = dots;
pascal@13691 111 break;
pascal@13691 112 case 0x0001:
pascal@13691 113 isofilename = dots + 1;
pascal@13691 114 break;
pascal@13691 115 default:
pascal@13691 116 n = isofilename[-1];
pascal@13691 117 if (* (short *) (isofilename + n - 2) == 0x313B)
pascal@13691 118 n -= 2; // remove ;1
pascal@13691 119 if (isofilename[n - 1] == '.') n--;
pascal@13691 120 isofilename[n] = 0;
pascal@13691 121 }
pascal@13691 122 }
pascal@13691 123 pos += size;
pascal@13691 124 return 0;
pascal@13691 125 }
pascal@13691 126
pascal@17473 127 static int cpuhaslm(void)
pascal@17473 128 {
pascal@17473 129 #asm
pascal@17473 130 pushf // save flags
pascal@17473 131 // bits 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
pascal@17473 132 // flags 0 NT IOPL OF DF IF TF SF ZF 0 AF 0 PF 1 CF
pascal@17473 133 mov ax, #0x1000
pascal@17473 134 push ax
pascal@17473 135 popf // < 286 : flags[12..15] are forced 1
pascal@17473 136 pushf // = 286 : flags[12..15] are forced 0
pascal@17473 137 pop bx // > 286 : only flags[15] is forced 0
pascal@17473 138 popf // restore flags (IOPL)
pascal@17473 139 add bh, ah // test F0 and 00 cases
pascal@17473 140 cmp bh, ah
pascal@17473 141 cbw
pascal@17473 142 jbe not386 // C=8086/80186, Z=80286
pascal@17473 143 use16 386
pascal@17473 144 pushfd
pascal@17473 145 pushfd
pascal@17473 146 pop ebx
pascal@17473 147 mov ecx, ebx
pascal@17473 148 btc ebx, #21 // toggle CPUID feature bit
pascal@17473 149 push ebx
pascal@17473 150 popfd
pascal@17473 151 pushfd
pascal@17473 152 pop ebx
pascal@17473 153 popfd
pascal@17473 154 xor ebx, ecx
pascal@17473 155 bt ebx, #21 // CPUID feature bit ?
pascal@17473 156 jnc nocpuid
pascal@17473 157 mov eax, #0x80000001 // Extended Processor Info and Feature Bits
pascal@17473 158 .byte 0x0F, 0xA2 // cpuid
pascal@17473 159 xor ax, ax
pascal@17473 160 bt edx, #29 // LM feature bit ?
pascal@17473 161 adc ax, ax
pascal@17473 162 use16 86
pascal@17473 163 nocpuid:
pascal@17473 164 not386:
pascal@17473 165 #endasm
pascal@17473 166 }
pascal@17473 167
pascal@13691 168 #define IS_DIR(x)( ((x) & ~0777) == 040000)
pascal@17473 169 int isoopen(char *filename)
pascal@13691 170 {
pascal@13691 171 int restart;
pascal@17473 172 char *name, *s, c;
pascal@17473 173 int _64bits = cpuhaslm();
pascal@13691 174
pascal@17473 175 retry32:
pascal@17473 176 name = filename;
pascal@13691 177 while (*name == '/') {
pascal@13691 178 name++;
pascal@13691 179 isoreset(NULL);
pascal@13691 180 }
pascal@13691 181 s = name;
pascal@13691 182 while (1) {
pascal@13691 183 while (*s && *s != '/') s++;
pascal@13691 184 c = *s;
pascal@13691 185 *s = 0;
pascal@13691 186 for (restart = 1; isoreaddir(restart) == 0; restart = 0) {
pascal@17473 187 char *n = name, *i = isofilename;
pascal@17473 188 if (_64bits) {
pascal@17473 189 int len = strlen(name);
pascal@17473 190 if (strncmp(name, isofilename), len) continue;
pascal@17473 191 n = "64";
pascal@17473 192 i += len;
pascal@17473 193 }
pascal@17473 194 if (strcmp(n, i)) continue;
pascal@13691 195 if (IS_DIR(isofilemod)) {
pascal@13691 196 isodirofs = isofileofs;
pascal@13691 197 isodirsize = isofilesize;
pascal@13691 198 if (c) {
pascal@13691 199 *s++ = c;
pascal@13691 200 name = s;
pascal@13691 201 goto next;
pascal@13691 202 }
pascal@13691 203 }
pascal@13691 204 return 0;
pascal@13691 205 }
pascal@17473 206 if (_64bits) {
pascal@17473 207 _64bits = 0;
pascal@17473 208 *s = c;
pascal@17473 209 goto retry32;
pascal@17473 210 }
pascal@13691 211 return -1;
pascal@13691 212 next: ;
pascal@13691 213 }
pascal@13691 214 }