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 CONFIG_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(struct blk_desc *dev_desc) 130 { 131 int i; 132 int limit; 133 char *s; 134 135 s = env_get("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 = blk_dread(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(struct blk_desc *dev_desc) 170 { 171 int i; 172 int limit; 173 char *s; 174 175 s = env_get("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 = blk_dread(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 static int part_test_amiga(struct blk_desc *dev_desc) 211 { 212 struct rigid_disk_block *rdb; 213 struct bootcode_block *bootcode; 214 215 PRINTF("part_test_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("part_test_amiga: bootable Amiga disk\n"); 223 else 224 PRINTF("part_test_amiga: non-bootable Amiga disk\n"); 225 226 return 0; 227 } 228 else 229 { 230 PRINTF("part_test_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(struct blk_desc *dev_desc, 240 int partnum) 241 { 242 struct rigid_disk_block *rdb; 243 struct partition_block *p; 244 u32 block; 245 246 PRINTF("Trying to find partition block %d\n", partnum); 247 rdb = get_rdisk(dev_desc); 248 if (!rdb) 249 { 250 PRINTF("find_partition: no rdb found\n"); 251 return NULL; 252 } 253 254 PRINTF("find_partition: Scanning partition list\n"); 255 256 block = rdb->partition_list; 257 PRINTF("find_partition: partition list at 0x%x\n", block); 258 259 while (block != 0xFFFFFFFF) 260 { 261 ulong res = blk_dread(dev_desc, block, 1, (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 static int part_get_info_amiga(struct blk_desc *dev_desc, int part, 294 disk_partition_t *info) 295 { 296 struct partition_block *p = find_partition(dev_desc, part-1); 297 struct amiga_part_geometry *g; 298 u32 disk_type; 299 300 if (!p) return -1; 301 302 g = (struct amiga_part_geometry *)&(p->environment); 303 info->start = g->low_cyl * g->block_per_track * g->surfaces; 304 info->size = (g->high_cyl - g->low_cyl + 1) * g->block_per_track * g->surfaces - 1; 305 info->blksz = rdb.block_bytes; 306 bcpl_strcpy((char *)info->name, p->drive_name); 307 308 309 disk_type = g->dos_type; 310 311 info->type[0] = (disk_type & 0xFF000000)>>24; 312 info->type[1] = (disk_type & 0x00FF0000)>>16; 313 info->type[2] = (disk_type & 0x0000FF00)>>8; 314 info->type[3] = '\\'; 315 info->type[4] = (disk_type & 0x000000FF) + '0'; 316 info->type[5] = 0; 317 318 return 0; 319 } 320 321 static void part_print_amiga(struct blk_desc *dev_desc) 322 { 323 struct rigid_disk_block *rdb; 324 struct bootcode_block *boot; 325 struct partition_block *p; 326 u32 block; 327 int i = 1; 328 329 rdb = get_rdisk(dev_desc); 330 if (!rdb) 331 { 332 PRINTF("part_print_amiga: no rdb found\n"); 333 return; 334 } 335 336 PRINTF("part_print_amiga: Scanning partition list\n"); 337 338 block = rdb->partition_list; 339 PRINTF("part_print_amiga: partition list at 0x%x\n", block); 340 341 printf("Summary: DiskBlockSize: %d\n" 342 " Cylinders : %d\n" 343 " Sectors/Track: %d\n" 344 " Heads : %d\n\n", 345 rdb->block_bytes, rdb->cylinders, rdb->sectors, 346 rdb->heads); 347 348 printf(" First Num. \n" 349 "Nr. Part. Name Block Block Type Boot Priority\n"); 350 351 while (block != 0xFFFFFFFF) 352 { 353 ulong res; 354 355 PRINTF("Trying to load block #0x%X\n", block); 356 357 res = blk_dread(dev_desc, block, 1, (ulong *)block_buffer); 358 if (res == 1) 359 { 360 p = (struct partition_block *)block_buffer; 361 if (p->id == AMIGA_ID_PART) 362 { 363 PRINTF("PART block suspect at 0x%x, checking checksum\n",block); 364 if (sum_block((struct block_header *)p) == 0) 365 { 366 printf("%-4d ", i); i++; 367 print_part_info(p); 368 block = p->next; 369 } 370 } else block = 0xFFFFFFFF; 371 } else block = 0xFFFFFFFF; 372 } 373 374 boot = get_bootcode(dev_desc); 375 if (boot) 376 { 377 printf("Disk is bootable\n"); 378 } 379 } 380 381 U_BOOT_PART_TYPE(amiga) = { 382 .name = "AMIGA", 383 .part_type = PART_TYPE_AMIGA, 384 .max_entries = AMIGA_ENTRY_NUMBERS, 385 .get_info = part_get_info_amiga, 386 .print = part_print_amiga, 387 .test = part_test_amiga, 388 }; 389 390 #endif 391