#include #include #include #include #include #include #include #include #include #include #include static int device_probe_partitions_dos (struct device* device) { struct dos_mbr mbr; memset (&mbr, 0, sizeof (mbr)); size_t sector = 0; size_t sector_count = 1; size_t sector_size; device_op_func_t ops[] = { [XDRV_GET_SIZE] = &partdrv_get_size, [XDRV_GET_SECTOR_SIZE] = &partdrv_get_sector_size, [XDRV_GET_DEVICE_TYPE] = &partdrv_get_device_type, [XDRV_READ] = &partdrv_read, [XDRV_WRITE] = &partdrv_write, }; spin_lock (&device->lock); device_op (device, XDRV_GET_SECTOR_SIZE, NULL, NULL, §or_size); int ret = device_op (device, XDRV_READ, NULL, NULL, §or, §or_count, &mbr); if (ret < 0) { spin_unlock (&device->lock); return ret; } if (!(mbr.valid_sign[0] == 0x55 && mbr.valid_sign[1] == 0xAA)) { spin_unlock (&device->lock); return -ST_PARTITION_ERROR; } for (size_t i = 0; i < lengthof (mbr.ptes); i++) { struct dos_pte* pte = &mbr.ptes[i]; struct partdrv_init init = { .start_sector = pte->start_lba, .total_size = pte->sector_count * sector_size, .super = device, }; char key[fieldsizeof (struct device, key)]; memset (key, 0, sizeof (key)); snprintf (key, sizeof (key), "%sp%zu", device->key, i); device_create (key, ops, lengthof (ops), &partdrv_init, &partdrv_fini, &init); } spin_unlock (&device->lock); return ST_OK; } int device_probe_partitions (struct device* device) { return device_probe_partitions_dos (device); }