[ef142d7] | 1 | /***************************************************************************** |
---|
| 2 | * |
---|
| 3 | * ide_part_table.c |
---|
| 4 | * |
---|
| 5 | * The implementation of library supporting "MS-DOS-style" partition table |
---|
| 6 | * |
---|
| 7 | * |
---|
| 8 | * Copyright (C) 2002 OKTET Ltd., St.-Petersburg, Russia |
---|
| 9 | * |
---|
| 10 | * Author: Konstantin Abramenko <Konstantin.Abramenko@oktet.ru> |
---|
| 11 | * Alexander Kukuta <Alexander.Kukuta@oktet.ru> |
---|
| 12 | * |
---|
| 13 | * The license and distribution terms for this file may be |
---|
| 14 | * found in the file LICENSE in this distribution or at |
---|
[5b38506] | 15 | * http://www.rtems.com/license/LICENSE. |
---|
[ef142d7] | 16 | * |
---|
| 17 | * $Id$ |
---|
| 18 | * |
---|
| 19 | *****************************************************************************/ |
---|
| 20 | |
---|
[006fa1ef] | 21 | #if HAVE_CONFIG_H |
---|
| 22 | #include "config.h" |
---|
| 23 | #endif |
---|
| 24 | |
---|
[dbe06865] | 25 | #include <string.h> |
---|
[ef142d7] | 26 | |
---|
[006fa1ef] | 27 | #include <rtems/ide_part_table.h> |
---|
| 28 | |
---|
[ef142d7] | 29 | /* |
---|
| 30 | * get_sector -- |
---|
| 31 | * gets sector from the disk |
---|
| 32 | * |
---|
| 33 | * PARAMETERS: |
---|
| 34 | * dev - device number |
---|
| 35 | * sector_num - number of sector to read |
---|
| 36 | * sector - returned pointer to pointer to allocated |
---|
| 37 | * sector_data_t structure |
---|
| 38 | * |
---|
| 39 | * RETURNS: |
---|
| 40 | * RTEMS_SUCCESSFUL, if success; |
---|
| 41 | * RTEMS_NO_MEMORY, if canot allocate memory for sector data; |
---|
| 42 | * other error codes returned by rtems_bdbuf_read(). |
---|
| 43 | * |
---|
| 44 | * NOTES: |
---|
| 45 | * get_sector() operates with device via bdbuf library, |
---|
| 46 | * and does not support devices with sector size other than 512 bytes |
---|
| 47 | */ |
---|
| 48 | static rtems_status_code |
---|
[3899a537] | 49 | get_sector(dev_t dev, uint32_t sector_num, rtems_sector_data_t **sector) |
---|
[ef142d7] | 50 | { |
---|
[3899a537] | 51 | rtems_sector_data_t *s; |
---|
| 52 | rtems_bdbuf_buffer *buf; |
---|
| 53 | rtems_status_code rc; |
---|
[048dcd2b] | 54 | |
---|
[ef142d7] | 55 | if (sector == NULL) |
---|
| 56 | { |
---|
| 57 | return RTEMS_INTERNAL_ERROR; |
---|
| 58 | } |
---|
| 59 | |
---|
[3899a537] | 60 | s = (rtems_sector_data_t *) malloc(sizeof(rtems_sector_data_t) + RTEMS_IDE_SECTOR_SIZE); |
---|
[ef142d7] | 61 | if (s == NULL) |
---|
| 62 | { |
---|
| 63 | return RTEMS_NO_MEMORY; |
---|
| 64 | } |
---|
[048dcd2b] | 65 | |
---|
[ef142d7] | 66 | rc = rtems_bdbuf_read(dev, sector_num, &buf); |
---|
| 67 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 68 | { |
---|
| 69 | free(s); |
---|
| 70 | return rc; |
---|
| 71 | } |
---|
[048dcd2b] | 72 | |
---|
[ef142d7] | 73 | memcpy(s->data, buf->buffer, RTEMS_IDE_SECTOR_SIZE); |
---|
| 74 | s->sector_num = sector_num; |
---|
| 75 | |
---|
| 76 | *sector = s; |
---|
[048dcd2b] | 77 | |
---|
[ef142d7] | 78 | rtems_bdbuf_release(buf); |
---|
[048dcd2b] | 79 | |
---|
[ef142d7] | 80 | return RTEMS_SUCCESSFUL; |
---|
| 81 | } |
---|
| 82 | |
---|
| 83 | |
---|
| 84 | /* |
---|
| 85 | * msdos_signature_check -- |
---|
| 86 | * checks if the partition table sector has msdos signature |
---|
| 87 | * |
---|
| 88 | * PARAMETERS: |
---|
| 89 | * sector - sector to check |
---|
| 90 | * |
---|
| 91 | * RETURNS: |
---|
[4f971343] | 92 | * true if sector has msdos signature, false otherwise |
---|
[ef142d7] | 93 | */ |
---|
[e03c37a] | 94 | static bool |
---|
[3899a537] | 95 | msdos_signature_check (rtems_sector_data_t *sector) |
---|
[ef142d7] | 96 | { |
---|
[c01d95b7] | 97 | uint8_t *p = sector->data + RTEMS_IDE_PARTITION_MSDOS_SIGNATURE_OFFSET; |
---|
[ef142d7] | 98 | |
---|
| 99 | return ((p[0] == RTEMS_IDE_PARTITION_MSDOS_SIGNATURE_DATA1) && |
---|
| 100 | (p[1] == RTEMS_IDE_PARTITION_MSDOS_SIGNATURE_DATA2)); |
---|
| 101 | } |
---|
| 102 | |
---|
| 103 | |
---|
| 104 | /* |
---|
| 105 | * is_extended -- |
---|
| 106 | * checks if the partition type is extended |
---|
| 107 | * |
---|
| 108 | * PARAMETERS: |
---|
| 109 | * type - type of partition to check |
---|
| 110 | * |
---|
| 111 | * RETURNS: |
---|
[4f971343] | 112 | * true if partition type is extended, false otherwise |
---|
[ef142d7] | 113 | */ |
---|
[e03c37a] | 114 | static bool |
---|
[8b96149] | 115 | is_extended(uint8_t type) |
---|
[ef142d7] | 116 | { |
---|
| 117 | return ((type == EXTENDED_PARTITION) || (type == LINUX_EXTENDED)); |
---|
| 118 | } |
---|
| 119 | |
---|
[dbe06865] | 120 | /* |
---|
| 121 | * is_fat_partition -- |
---|
| 122 | * checks if the partition type is defined for FAT |
---|
| 123 | * |
---|
| 124 | * PARAMETERS: |
---|
| 125 | * type - type of partition to check |
---|
| 126 | * |
---|
| 127 | * RETURNS: |
---|
[4f971343] | 128 | * true if partition type is extended, false otherwise |
---|
[dbe06865] | 129 | */ |
---|
[e03c37a] | 130 | static bool |
---|
[8b96149] | 131 | is_fat_partition(uint8_t type) |
---|
[dbe06865] | 132 | { |
---|
[c01d95b7] | 133 | static const uint8_t fat_part_types[] = { |
---|
[dbe06865] | 134 | DOS_FAT12_PARTITION,DOS_FAT16_PARTITION, |
---|
| 135 | DOS_P32MB_PARTITION, |
---|
| 136 | FAT32_PARTITION ,FAT32_LBA_PARTITION, |
---|
| 137 | FAT16_LBA_PARTITION |
---|
| 138 | }; |
---|
| 139 | |
---|
| 140 | return (NULL != memchr(fat_part_types,type,sizeof(fat_part_types))); |
---|
| 141 | } |
---|
| 142 | |
---|
[ef142d7] | 143 | |
---|
| 144 | /* |
---|
| 145 | * data_to_part_desc -- |
---|
| 146 | * parses raw partition table sector data |
---|
| 147 | * to partition description structure |
---|
| 148 | * |
---|
| 149 | * PARAMETERS: |
---|
| 150 | * data - raw partition table sector data |
---|
| 151 | * new_part_desc - pointer to returned partition description structure |
---|
| 152 | * |
---|
| 153 | * RETURNS: |
---|
| 154 | * RTEMS_SUCCESSFUL, if success; |
---|
| 155 | * RTEMS_NO_MEMOTY, if cannot allocate memory for part_desc_t strucure; |
---|
| 156 | * RTEMS_INTERNAL_ERROR, if other error occurs. |
---|
| 157 | */ |
---|
| 158 | static rtems_status_code |
---|
[3899a537] | 159 | data_to_part_desc(uint8_t *data, rtems_part_desc_t **new_part_desc) |
---|
[ef142d7] | 160 | { |
---|
[3899a537] | 161 | rtems_part_desc_t *part_desc; |
---|
| 162 | uint32_t temp; |
---|
[ef142d7] | 163 | |
---|
| 164 | if (new_part_desc == NULL) |
---|
| 165 | { |
---|
| 166 | return RTEMS_INTERNAL_ERROR; |
---|
| 167 | } |
---|
[048dcd2b] | 168 | |
---|
[ef142d7] | 169 | *new_part_desc = NULL; |
---|
| 170 | |
---|
[3899a537] | 171 | if ((part_desc = calloc(1, sizeof(rtems_part_desc_t))) == NULL) |
---|
[ef142d7] | 172 | { |
---|
| 173 | return RTEMS_NO_MEMORY; |
---|
| 174 | } |
---|
| 175 | |
---|
| 176 | part_desc->bootable = *(data + RTEMS_IDE_PARTITION_BOOTABLE_OFFSET); |
---|
| 177 | part_desc->sys_type = *(data + RTEMS_IDE_PARTITION_SYS_TYPE_OFFSET); |
---|
| 178 | |
---|
| 179 | /* read the offset start position and partition size in sectors */ |
---|
| 180 | |
---|
| 181 | /* due to incorrect data alignment one have to align data first */ |
---|
[c01d95b7] | 182 | memcpy(&temp, data + RTEMS_IDE_PARTITION_START_OFFSET, sizeof(uint32_t)); |
---|
[ef142d7] | 183 | part_desc->start = LE_TO_CPU_U32(temp); |
---|
| 184 | |
---|
[c01d95b7] | 185 | memcpy(&temp, data + RTEMS_IDE_PARTITION_SIZE_OFFSET, sizeof(uint32_t)); |
---|
[ef142d7] | 186 | part_desc->size = LE_TO_CPU_U32(temp); |
---|
| 187 | |
---|
[dbe06865] | 188 | /* |
---|
[8b96149] | 189 | * use partitions that are |
---|
[dbe06865] | 190 | * - extended |
---|
| 191 | * or |
---|
| 192 | * - FAT type and non-zero |
---|
| 193 | */ |
---|
| 194 | if (is_extended(part_desc->sys_type) || |
---|
[97a95490] | 195 | ((is_fat_partition(part_desc->sys_type)) && (part_desc->size != 0))) { |
---|
[dbe06865] | 196 | *new_part_desc = part_desc; |
---|
| 197 | } |
---|
[8b96149] | 198 | else { |
---|
[dbe06865] | 199 | /* empty partition */ |
---|
| 200 | free(part_desc); |
---|
[ef142d7] | 201 | } |
---|
| 202 | return RTEMS_SUCCESSFUL; |
---|
| 203 | } |
---|
| 204 | |
---|
| 205 | |
---|
| 206 | /* |
---|
| 207 | * read_extended_partition -- |
---|
| 208 | * recursively reads extended partition sector from the device |
---|
| 209 | * and constructs the partition table tree |
---|
| 210 | * |
---|
| 211 | * PARAMETERS: |
---|
[8b96149] | 212 | * start - start sector of primary extended partition, used for |
---|
[ef142d7] | 213 | * calculation of absolute partition sector address |
---|
| 214 | * ext_part - description of extended partition to process |
---|
| 215 | * |
---|
| 216 | * RETURNS: |
---|
| 217 | * RTEMS_SUCCESSFUL if success, |
---|
| 218 | * RTEMS_NO_MEMOTY if cannot allocate memory for part_desc_t strucure, |
---|
| 219 | * RTEMS_INTERNAL_ERROR if other error occurs. |
---|
| 220 | */ |
---|
| 221 | static rtems_status_code |
---|
[3899a537] | 222 | read_extended_partition(uint32_t start, rtems_part_desc_t *ext_part) |
---|
[ef142d7] | 223 | { |
---|
[3899a537] | 224 | int i; |
---|
| 225 | dev_t dev; |
---|
| 226 | rtems_sector_data_t *sector; |
---|
| 227 | uint32_t here; |
---|
| 228 | uint8_t *data; |
---|
| 229 | rtems_part_desc_t *new_part_desc; |
---|
| 230 | rtems_status_code rc; |
---|
[ef142d7] | 231 | |
---|
| 232 | if ((ext_part == NULL) || (ext_part->disk_desc == NULL)) |
---|
| 233 | { |
---|
| 234 | return RTEMS_INTERNAL_ERROR; |
---|
| 235 | } |
---|
[048dcd2b] | 236 | |
---|
[ef142d7] | 237 | dev = ext_part->disk_desc->dev; |
---|
| 238 | |
---|
| 239 | /* get start sector of current extended partition */ |
---|
| 240 | here = ext_part->start; |
---|
| 241 | |
---|
| 242 | /* get first extended partition sector */ |
---|
| 243 | |
---|
| 244 | rc = get_sector(dev, here, §or); |
---|
| 245 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 246 | { |
---|
| 247 | return rc; |
---|
| 248 | } |
---|
| 249 | |
---|
| 250 | if (!msdos_signature_check(sector)) |
---|
| 251 | { |
---|
| 252 | return RTEMS_INTERNAL_ERROR; |
---|
| 253 | } |
---|
| 254 | |
---|
| 255 | /* read and process up to 4 logical partition descriptors */ |
---|
| 256 | |
---|
| 257 | data = sector->data + RTEMS_IDE_PARTITION_TABLE_OFFSET; |
---|
| 258 | |
---|
[8b96149] | 259 | for (i = 0; i < RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; i++) |
---|
[ef142d7] | 260 | { |
---|
| 261 | /* if data_to_part_desc fails skip this partition |
---|
| 262 | * and parse the next one |
---|
| 263 | */ |
---|
| 264 | rc = data_to_part_desc(data, &new_part_desc); |
---|
| 265 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 266 | { |
---|
| 267 | free(sector); |
---|
| 268 | return rc; |
---|
| 269 | } |
---|
[048dcd2b] | 270 | |
---|
[ef142d7] | 271 | if (new_part_desc == NULL) |
---|
| 272 | { |
---|
| 273 | data += RTEMS_IDE_PARTITION_DESCRIPTOR_SIZE; |
---|
| 274 | continue; |
---|
| 275 | } |
---|
| 276 | |
---|
| 277 | ext_part->sub_part[i] = new_part_desc; |
---|
| 278 | new_part_desc->ext_part = ext_part; |
---|
| 279 | new_part_desc->disk_desc = ext_part->disk_desc; |
---|
| 280 | |
---|
[8b96149] | 281 | if (is_extended(new_part_desc->sys_type)) |
---|
[ef142d7] | 282 | { |
---|
| 283 | new_part_desc->log_id = EMPTY_PARTITION; |
---|
| 284 | new_part_desc->start += start; |
---|
[8b96149] | 285 | read_extended_partition(start, new_part_desc); |
---|
[ef142d7] | 286 | } |
---|
[8b96149] | 287 | else |
---|
[ef142d7] | 288 | { |
---|
[3899a537] | 289 | rtems_disk_desc_t *disk_desc = new_part_desc->disk_desc; |
---|
[ef142d7] | 290 | disk_desc->partitions[disk_desc->last_log_id] = new_part_desc; |
---|
| 291 | new_part_desc->log_id = ++disk_desc->last_log_id; |
---|
| 292 | new_part_desc->start += here; |
---|
| 293 | new_part_desc->end = new_part_desc->start + new_part_desc->size - 1; |
---|
| 294 | } |
---|
| 295 | data += RTEMS_IDE_PARTITION_DESCRIPTOR_SIZE; |
---|
| 296 | } |
---|
| 297 | |
---|
| 298 | free(sector); |
---|
[048dcd2b] | 299 | |
---|
[ef142d7] | 300 | return RTEMS_SUCCESSFUL; |
---|
| 301 | } |
---|
| 302 | |
---|
| 303 | |
---|
| 304 | /* |
---|
| 305 | * read_mbr -- |
---|
| 306 | * reads Master Boot Record (sector 0) of physical device and |
---|
| 307 | * constructs disk description structure |
---|
| 308 | * |
---|
| 309 | * PARAMETERS: |
---|
| 310 | * disk_desc - returned disc description structure |
---|
| 311 | * |
---|
| 312 | * RETURNS: |
---|
| 313 | * RTEMS_SUCCESSFUL if success, |
---|
| 314 | * RTEMS_INTERNAL_ERROR otherwise |
---|
| 315 | */ |
---|
| 316 | static rtems_status_code |
---|
[3899a537] | 317 | read_mbr(rtems_disk_desc_t *disk_desc) |
---|
[ef142d7] | 318 | { |
---|
[3899a537] | 319 | int part_num; |
---|
| 320 | rtems_sector_data_t *sector; |
---|
| 321 | rtems_part_desc_t *part_desc; |
---|
| 322 | uint8_t *data; |
---|
| 323 | rtems_status_code rc; |
---|
| 324 | dev_t dev = disk_desc->dev; |
---|
[ef142d7] | 325 | |
---|
| 326 | /* get MBR sector */ |
---|
| 327 | rc = get_sector(dev, 0, §or); |
---|
| 328 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 329 | { |
---|
| 330 | return rc; |
---|
| 331 | } |
---|
| 332 | |
---|
| 333 | /* check if the partition table structure is MS-DOS style */ |
---|
| 334 | if (!msdos_signature_check(sector)) |
---|
| 335 | { |
---|
| 336 | return RTEMS_INTERNAL_ERROR; |
---|
| 337 | } |
---|
| 338 | |
---|
| 339 | /* read and process 4 primary partition descriptors */ |
---|
| 340 | |
---|
| 341 | data = sector->data + RTEMS_IDE_PARTITION_TABLE_OFFSET; |
---|
| 342 | |
---|
| 343 | for (part_num = 0; |
---|
| 344 | part_num < RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; |
---|
| 345 | part_num++) |
---|
| 346 | { |
---|
| 347 | rc = data_to_part_desc(data, &part_desc); |
---|
| 348 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 349 | { |
---|
| 350 | free(sector); |
---|
| 351 | return rc; |
---|
| 352 | } |
---|
| 353 | |
---|
[8b96149] | 354 | if (part_desc != NULL) |
---|
[ef142d7] | 355 | { |
---|
| 356 | part_desc->log_id = part_num + 1; |
---|
| 357 | part_desc->disk_desc = disk_desc; |
---|
| 358 | part_desc->end = part_desc->start + part_desc->size - 1; |
---|
| 359 | disk_desc->partitions[part_num] = part_desc; |
---|
[8b96149] | 360 | } |
---|
[ef142d7] | 361 | else |
---|
| 362 | { |
---|
| 363 | disk_desc->partitions[part_num] = NULL; |
---|
| 364 | } |
---|
| 365 | |
---|
| 366 | data += RTEMS_IDE_PARTITION_DESCRIPTOR_SIZE; |
---|
| 367 | } |
---|
| 368 | |
---|
| 369 | free(sector); |
---|
[048dcd2b] | 370 | |
---|
[ef142d7] | 371 | disk_desc->last_log_id = RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; |
---|
| 372 | |
---|
| 373 | /* There cannot be more than one extended partition, |
---|
| 374 | but we are to process each primary partition */ |
---|
| 375 | for (part_num = 0; |
---|
| 376 | part_num < RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; |
---|
| 377 | part_num++) |
---|
| 378 | { |
---|
[eb961961] | 379 | part_desc = disk_desc->partitions[part_num]; |
---|
| 380 | if (part_desc != NULL && is_extended(part_desc->sys_type)) |
---|
[ef142d7] | 381 | { |
---|
[eb961961] | 382 | read_extended_partition(part_desc->start, part_desc); |
---|
[ef142d7] | 383 | } |
---|
| 384 | } |
---|
| 385 | |
---|
| 386 | return RTEMS_SUCCESSFUL; |
---|
| 387 | } |
---|
| 388 | |
---|
| 389 | |
---|
| 390 | /* |
---|
| 391 | * partition free -- |
---|
| 392 | * frees partition description structure |
---|
| 393 | * |
---|
| 394 | * PARAMETERS: |
---|
| 395 | * part_desc - returned disc description structure |
---|
| 396 | * |
---|
| 397 | * RETURNS: |
---|
| 398 | * N/A |
---|
| 399 | */ |
---|
| 400 | static void |
---|
[3899a537] | 401 | partition_free(rtems_part_desc_t *part_desc) |
---|
[ef142d7] | 402 | { |
---|
| 403 | int part_num; |
---|
| 404 | |
---|
| 405 | if (part_desc == NULL) |
---|
| 406 | return; |
---|
[048dcd2b] | 407 | |
---|
[ef142d7] | 408 | if (is_extended(part_desc->sys_type)) |
---|
| 409 | { |
---|
| 410 | for (part_num = 0; |
---|
| 411 | part_num < RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; |
---|
| 412 | part_num++) |
---|
| 413 | { |
---|
| 414 | partition_free(part_desc->sub_part[part_num]); |
---|
| 415 | } |
---|
| 416 | } |
---|
[048dcd2b] | 417 | |
---|
[ef142d7] | 418 | free(part_desc); |
---|
| 419 | } |
---|
| 420 | |
---|
| 421 | |
---|
| 422 | /* |
---|
| 423 | * rtems_ide_part_table_free - frees disk descriptor structure |
---|
| 424 | * |
---|
| 425 | * PARAMETERS: |
---|
| 426 | * disk_desc - disc descriptor structure to free |
---|
| 427 | * |
---|
| 428 | * RETURNS: |
---|
| 429 | * N/A |
---|
| 430 | */ |
---|
| 431 | void |
---|
[3899a537] | 432 | rtems_ide_part_table_free(rtems_disk_desc_t *disk_desc) |
---|
[ef142d7] | 433 | { |
---|
| 434 | int part_num; |
---|
| 435 | |
---|
| 436 | for (part_num = 0; part_num < RTEMS_IDE_PARTITION_MAX_SUB_PARTITION_NUMBER; part_num++) |
---|
| 437 | { |
---|
| 438 | partition_free(disk_desc->partitions[part_num]); |
---|
| 439 | } |
---|
[048dcd2b] | 440 | |
---|
[ef142d7] | 441 | free(disk_desc); |
---|
| 442 | } |
---|
| 443 | |
---|
| 444 | |
---|
| 445 | /* |
---|
| 446 | * rtems_ide_part_table_get - reads partition table structure from the device |
---|
| 447 | * and creates disk description structure |
---|
| 448 | * |
---|
| 449 | * PARAMETERS: |
---|
| 450 | * dev_name - path to physical device in /dev filesystem |
---|
| 451 | * disk_desc - returned disc description structure |
---|
| 452 | * |
---|
| 453 | * RETURNS: |
---|
| 454 | * RTEMS_SUCCESSFUL if success, |
---|
| 455 | * RTEMS_INTERNAL_ERROR otherwise |
---|
| 456 | */ |
---|
| 457 | rtems_status_code |
---|
[3899a537] | 458 | rtems_ide_part_table_get(const char *dev_name, rtems_disk_desc_t *disk_desc) |
---|
[ef142d7] | 459 | { |
---|
| 460 | struct stat dev_stat; |
---|
| 461 | rtems_status_code rc; |
---|
| 462 | |
---|
| 463 | rc = stat(dev_name, &dev_stat); |
---|
| 464 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 465 | { |
---|
| 466 | return RTEMS_INTERNAL_ERROR; |
---|
| 467 | } |
---|
| 468 | |
---|
| 469 | strncpy (disk_desc->dev_name, dev_name, 15); |
---|
[7baa484] | 470 | disk_desc->dev = dev_stat.st_rdev; |
---|
[ef142d7] | 471 | disk_desc->sector_size = (dev_stat.st_blksize) ? dev_stat.st_blksize : |
---|
| 472 | RTEMS_IDE_SECTOR_SIZE; |
---|
| 473 | |
---|
| 474 | rc = read_mbr(disk_desc); |
---|
| 475 | |
---|
| 476 | return rc; |
---|
| 477 | } |
---|
| 478 | |
---|
| 479 | |
---|
| 480 | /* |
---|
| 481 | * rtems_ide_part_table_initialize - initializes logical devices |
---|
| 482 | * on the physical IDE drive |
---|
| 483 | * |
---|
| 484 | * PARAMETERS: |
---|
| 485 | * dev_name - path to physical device in /dev filesystem |
---|
| 486 | * |
---|
| 487 | * RETURNS: |
---|
| 488 | * RTEMS_SUCCESSFUL if success, |
---|
| 489 | * RTEMS_NO_MEMOTY if cannot have not enough memory, |
---|
| 490 | * RTEMS_INTERNAL_ERROR if other error occurs. |
---|
| 491 | */ |
---|
| 492 | rtems_status_code |
---|
| 493 | rtems_ide_part_table_initialize(char *dev_name) |
---|
| 494 | { |
---|
| 495 | int part_num; |
---|
| 496 | dev_t dev; |
---|
[3899a537] | 497 | rtems_disk_desc_t *disk_desc; |
---|
[ef142d7] | 498 | rtems_device_major_number major; |
---|
| 499 | rtems_device_minor_number minor; |
---|
| 500 | rtems_status_code rc; |
---|
[3899a537] | 501 | rtems_part_desc_t *part_desc; |
---|
[ef142d7] | 502 | |
---|
| 503 | /* logical device name /dev/hdxyy */ |
---|
| 504 | char name[RTEMS_IDE_PARTITION_DEV_NAME_LENGTH_MAX]; |
---|
| 505 | |
---|
[3899a537] | 506 | disk_desc = (rtems_disk_desc_t *) calloc(1, sizeof(rtems_disk_desc_t)); |
---|
[ef142d7] | 507 | if (disk_desc == NULL) |
---|
| 508 | { |
---|
| 509 | return RTEMS_NO_MEMORY; |
---|
| 510 | } |
---|
[048dcd2b] | 511 | |
---|
[ef142d7] | 512 | /* get partition table */ |
---|
| 513 | rc = rtems_ide_part_table_get(dev_name, disk_desc); |
---|
| 514 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 515 | { |
---|
| 516 | return rc; |
---|
| 517 | } |
---|
| 518 | |
---|
| 519 | /* To avoid device numbers conflicts we have to use for logic disk the same |
---|
| 520 | * device major number as ATA device has, and minor number that equals to |
---|
| 521 | * sum of logic disk partition number and the minor number of physical disk |
---|
| 522 | */ |
---|
| 523 | |
---|
| 524 | rtems_filesystem_split_dev_t (disk_desc->dev, major, minor); |
---|
| 525 | |
---|
| 526 | /* create logical disks on the physical one */ |
---|
| 527 | for (part_num = 0; part_num < disk_desc->last_log_id; part_num++) |
---|
| 528 | { |
---|
| 529 | sprintf(name, "%s%d", dev_name, part_num + 1); |
---|
| 530 | dev = rtems_filesystem_make_dev_t(major, ++minor); |
---|
| 531 | |
---|
| 532 | part_desc = disk_desc->partitions[part_num]; |
---|
| 533 | if (part_desc == NULL) |
---|
| 534 | { |
---|
| 535 | continue; |
---|
| 536 | } |
---|
| 537 | |
---|
| 538 | rc = rtems_disk_create_log(dev, disk_desc->dev, part_desc->start, |
---|
| 539 | part_desc->size, name); |
---|
| 540 | if (rc != RTEMS_SUCCESSFUL) |
---|
| 541 | { |
---|
[d63a2c2] | 542 | fprintf(stdout,"Cannot create device %s, error code %d\n", name, rc); |
---|
[ef142d7] | 543 | continue; |
---|
| 544 | } |
---|
| 545 | } |
---|
| 546 | |
---|
| 547 | rtems_ide_part_table_free(disk_desc); |
---|
| 548 | |
---|
| 549 | return RTEMS_SUCCESSFUL; |
---|
| 550 | } |
---|