1 /* 2 * (C) Copyright 2001 3 * Hans-Joerg Frieden, Hyperion Entertainment 4 * Hans-JoergF@hyperion-entertainment.com 5 * 6 * SPDX-License-Identifier: GPL-2.0+ 7 */ 8 #include <common.h> 9 #include <command.h> 10 #include <ide.h> 11 #include "part_amiga.h" 12 13 #ifdef HAVE_BLOCK_DEVICE 14 15 #undef AMIGA_DEBUG 16 17 #ifdef AMIGA_DEBUG 18 #define PRINTF(fmt, args...) printf(fmt ,##args) 19 #else 20 #define PRINTF(fmt, args...) 21 #endif 22 23 struct block_header 24 { 25 u32 id; 26 u32 summed_longs; 27 s32 chk_sum; 28 }; 29 30 static unsigned char block_buffer[DEFAULT_SECTOR_SIZE]; 31 static struct rigid_disk_block rdb = {0}; 32 static struct bootcode_block bootcode = {0}; 33 34 /* 35 * Copy a bcpl to a c string 36 */ 37 static void bcpl_strcpy(char *to, char *from) 38 { 39 int len = *from++; 40 41 while (len) 42 { 43 *to++ = *from++; 44 len--; 45 } 46 *to = 0; 47 } 48 49 /* 50 * Print a BCPL String. BCPL strings start with a byte with the length 51 * of the string, and don't contain a terminating nul character 52 */ 53 static void bstr_print(char *string) 54 { 55 int len = *string++; 56 char buffer[256]; 57 int i; 58 59 i = 0; 60 while (len) 61 { 62 buffer[i++] = *string++; 63 len--; 64 } 65 66 buffer[i] = 0; 67 printf("%-10s", buffer); 68 } 69 70 /* 71 * Sum a block. The checksum of a block must end up at zero 72 * to be valid. The chk_sum field is selected so that adding 73 * it yields zero. 74 */ 75 int sum_block(struct block_header *header) 76 { 77 s32 *block = (s32 *)header; 78 u32 i; 79 s32 sum = 0; 80 81 for (i = 0; i < header->summed_longs; i++) 82 sum += *block++; 83 84 return (sum != 0); 85 } 86 87 /* 88 * Print an AmigaOS disk type. Disk types are a four-byte identifier 89 * describing the file system. They are usually written as a three-letter 90 * word followed by a backslash and a version number. For example, 91 * DOS\0 would be the original file system. SFS\0 would be SmartFileSystem. 92 * DOS\1 is FFS. 93 */ 94 static void print_disk_type(u32 disk_type) 95 { 96 char buffer[6]; 97 buffer[0] = (disk_type & 0xFF000000)>>24; 98 buffer[1] = (disk_type & 0x00FF0000)>>16; 99 buffer[2] = (disk_type & 0x0000FF00)>>8; 100 buffer[3] = '\\'; 101 buffer[4] = (disk_type & 0x000000FF) + '0'; 102 buffer[5] = 0; 103 printf("%s", buffer); 104 } 105 106 /* 107 * Print the info contained within the given partition block 108 */ 109 static void print_part_info(struct partition_block *p) 110 { 111 struct amiga_part_geometry *g; 112 113 g = (struct amiga_part_geometry *)&(p->environment); 114 115 bstr_print(p->drive_name); 116 printf("%6d\t%6d\t", 117 g->low_cyl * g->block_per_track * g->surfaces , 118 (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1); 119 print_disk_type(g->dos_type); 120 printf("\t%5d\n", g->boot_priority); 121 } 122 123 /* 124 * Search for the Rigid Disk Block. The rigid disk block is required 125 * to be within the first 16 blocks of a drive, needs to have 126 * the ID AMIGA_ID_RDISK ('RDSK') and needs to have a valid 127 * sum-to-zero checksum 128 */ 129 struct rigid_disk_block *get_rdisk(block_dev_desc_t *dev_desc) 130 { 131 int i; 132 int limit; 133 char *s; 134 135 s = getenv("amiga_scanlimit"); 136 if (s) 137 limit = simple_strtoul(s, NULL, 10); 138 else 139 limit = AMIGA_BLOCK_LIMIT; 140 141 for (i=0; i<limit; i++) 142 { 143 ulong res = dev_desc->block_read(dev_desc, i, 1, (ulong *)block_buffer); 144 if (res == 1) 145 { 146 struct rigid_disk_block *trdb = (struct rigid_disk_block *)block_buffer; 147 if (trdb->id == AMIGA_ID_RDISK) 148 { 149 PRINTF("Rigid disk block suspect at %d, checking checksum\n",i); 150 if (sum_block((struct block_header *)block_buffer) == 0) 151 { 152 PRINTF("FOUND\n"); 153 memcpy(&rdb, trdb, sizeof(struct rigid_disk_block)); 154 return (struct rigid_disk_block *)&rdb; 155 } 156 } 157 } 158 } 159 PRINTF("Done scanning, no RDB found\n"); 160 return NULL; 161 } 162 163 /* 164 * Search for boot code 165 * Again, the first boot block must be located somewhere in the first 16 blocks, or rooted in the 166 * Ridgid disk block 167 */ 168 169 struct bootcode_block *get_bootcode(block_dev_desc_t *dev_desc) 170 { 171 int i; 172 int limit; 173 char *s; 174 175 s = getenv("amiga_scanlimit"); 176 if (s) 177 limit = simple_strtoul(s, NULL, 10); 178 else 179 limit = AMIGA_BLOCK_LIMIT; 180 181 PRINTF("Scanning for BOOT from 0 to %d\n", limit); 182 183 for (i = 0; i < limit; i++) 184 { 185 ulong res = dev_desc->block_read(dev_desc, i, 1, (ulong *)block_buffer); 186 if (res == 1) 187 { 188 struct bootcode_block *boot = (struct bootcode_block *)block_buffer; 189 if (boot->id == AMIGA_ID_BOOT) 190 { 191 PRINTF("BOOT block at %d, checking checksum\n", i); 192 if (sum_block((struct block_header *)block_buffer) == 0) 193 { 194 PRINTF("Found valid bootcode block\n"); 195 memcpy(&bootcode, boot, sizeof(struct bootcode_block)); 196 return &bootcode; 197 } 198 } 199 } 200 } 201 202 PRINTF("No boot code found on disk\n"); 203 return 0; 204 } 205 206 /* 207 * Test if the given partition has an Amiga partition table/Rigid 208 * Disk block 209 */ 210 int test_part_amiga(block_dev_desc_t *dev_desc) 211 { 212 struct rigid_disk_block *rdb; 213 struct bootcode_block *bootcode; 214 215 PRINTF("test_part_amiga: Testing for an Amiga RDB partition\n"); 216 217 rdb = get_rdisk(dev_desc); 218 if (rdb) 219 { 220 bootcode = get_bootcode(dev_desc); 221 if (bootcode) 222 PRINTF("test_part_amiga: bootable Amiga disk\n"); 223 else 224 PRINTF("test_part_amiga: non-bootable Amiga disk\n"); 225 226 return 0; 227 } 228 else 229 { 230 PRINTF("test_part_amiga: no RDB found\n"); 231 return -1; 232 } 233 234 } 235 236 /* 237 * Find partition number partnum on the given drive. 238 */ 239 static struct partition_block *find_partition(block_dev_desc_t *dev_desc, int partnum) 240 { 241 struct rigid_disk_block *rdb; 242 struct partition_block *p; 243 u32 block; 244 245 PRINTF("Trying to find partition block %d\n", partnum); 246 rdb = get_rdisk(dev_desc); 247 if (!rdb) 248 { 249 PRINTF("find_partition: no rdb found\n"); 250 return NULL; 251 } 252 253 PRINTF("find_partition: Scanning partition list\n"); 254 255 block = rdb->partition_list; 256 PRINTF("find_partition: partition list at 0x%x\n", block); 257 258 while (block != 0xFFFFFFFF) 259 { 260 ulong res = dev_desc->block_read(dev_desc, block, 1, 261 (ulong *)block_buffer); 262 if (res == 1) 263 { 264 p = (struct partition_block *)block_buffer; 265 if (p->id == AMIGA_ID_PART) 266 { 267 PRINTF("PART block suspect at 0x%x, checking checksum\n",block); 268 if (sum_block((struct block_header *)p) == 0) 269 { 270 if (partnum == 0) break; 271 else 272 { 273 partnum--; 274 block = p->next; 275 } 276 } 277 } else block = 0xFFFFFFFF; 278 } else block = 0xFFFFFFFF; 279 } 280 281 if (block == 0xFFFFFFFF) 282 { 283 PRINTF("PART block not found\n"); 284 return NULL; 285 } 286 287 return (struct partition_block *)block_buffer; 288 } 289 290 /* 291 * Get info about a partition 292 */ 293 int get_partition_info_amiga (block_dev_desc_t *dev_desc, int part, disk_partition_t *info) 294 { 295 struct partition_block *p = find_partition(dev_desc, part-1); 296 struct amiga_part_geometry *g; 297 u32 disk_type; 298 299 if (!p) return -1; 300 301 g = (struct amiga_part_geometry *)&(p->environment); 302 info->start = g->low_cyl * g->block_per_track * g->surfaces; 303 info->size = (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1; 304 info->blksz = rdb.block_bytes; 305 bcpl_strcpy(info->name, p->drive_name); 306 307 308 disk_type = g->dos_type; 309 310 info->type[0] = (disk_type & 0xFF000000)>>24; 311 info->type[1] = (disk_type & 0x00FF0000)>>16; 312 info->type[2] = (disk_type & 0x0000FF00)>>8; 313 info->type[3] = '\\'; 314 info->type[4] = (disk_type & 0x000000FF) + '0'; 315 info->type[5] = 0; 316 317 return 0; 318 } 319 320 void print_part_amiga (block_dev_desc_t *dev_desc) 321 { 322 struct rigid_disk_block *rdb; 323 struct bootcode_block *boot; 324 struct partition_block *p; 325 u32 block; 326 int i = 1; 327 328 rdb = get_rdisk(dev_desc); 329 if (!rdb) 330 { 331 PRINTF("print_part_amiga: no rdb found\n"); 332 return; 333 } 334 335 PRINTF("print_part_amiga: Scanning partition list\n"); 336 337 block = rdb->partition_list; 338 PRINTF("print_part_amiga: partition list at 0x%x\n", block); 339 340 printf("Summary: DiskBlockSize: %d\n" 341 " Cylinders : %d\n" 342 " Sectors/Track: %d\n" 343 " Heads : %d\n\n", 344 rdb->block_bytes, rdb->cylinders, rdb->sectors, 345 rdb->heads); 346 347 printf(" First Num. \n" 348 "Nr. Part. Name Block Block Type Boot Priority\n"); 349 350 while (block != 0xFFFFFFFF) 351 { 352 ulong res; 353 354 PRINTF("Trying to load block #0x%X\n", block); 355 356 res = dev_desc->block_read(dev_desc, block, 1, (ulong *)block_buffer); 357 if (res == 1) 358 { 359 p = (struct partition_block *)block_buffer; 360 if (p->id == AMIGA_ID_PART) 361 { 362 PRINTF("PART block suspect at 0x%x, checking checksum\n",block); 363 if (sum_block((struct block_header *)p) == 0) 364 { 365 printf("%-4d ", i); i++; 366 print_part_info(p); 367 block = p->next; 368 } 369 } else block = 0xFFFFFFFF; 370 } else block = 0xFFFFFFFF; 371 } 372 373 boot = get_bootcode(dev_desc); 374 if (boot) 375 { 376 printf("Disk is bootable\n"); 377 } 378 } 379 380 #endif 381