|
|
@@ -39,6 +39,7 @@ struct mmcsd_blk_device
|
|
|
#ifndef RT_MMCSD_MAX_PARTITION
|
|
|
#define RT_MMCSD_MAX_PARTITION 16
|
|
|
#endif
|
|
|
+#define RT_GPT_PARTITION_MAX 128
|
|
|
|
|
|
rt_int32_t mmcsd_num_wr_blocks(struct rt_mmcsd_card *card)
|
|
|
{
|
|
|
@@ -366,230 +367,235 @@ const static struct rt_device_ops mmcsd_blk_ops =
|
|
|
};
|
|
|
#endif
|
|
|
|
|
|
-rt_int32_t rt_mmcsd_blk_probe(struct rt_mmcsd_card *card)
|
|
|
+rt_int32_t gpt_device_probe(struct rt_mmcsd_card *card)
|
|
|
{
|
|
|
- rt_int32_t err = 0;
|
|
|
+ rt_int32_t err = RT_EOK;
|
|
|
rt_uint8_t i, status;
|
|
|
- rt_uint8_t *sector;
|
|
|
char dname[10];
|
|
|
char sname[16];
|
|
|
struct mmcsd_blk_device *blk_dev = RT_NULL;
|
|
|
- int gpt_chk = 0;
|
|
|
|
|
|
- LOG_D("probe mmcsd block device!");
|
|
|
- gpt_chk = check_gpt(card);
|
|
|
- if (gpt_chk == 1)
|
|
|
+ blk_dev = rt_calloc(1, sizeof(struct mmcsd_blk_device));
|
|
|
+ if (!blk_dev)
|
|
|
{
|
|
|
- status = RT_EOK;
|
|
|
+ LOG_E("mmcsd:malloc memory failed!");
|
|
|
+ return -1;
|
|
|
}
|
|
|
- else
|
|
|
- {
|
|
|
- err = mmcsd_set_blksize(card);
|
|
|
- if(err)
|
|
|
- {
|
|
|
- return err;
|
|
|
- }
|
|
|
- mmcsd_delay_ms(1);
|
|
|
- /* get the first sector to read partition table */
|
|
|
- sector = (rt_uint8_t *)rt_malloc(SECTOR_SIZE);
|
|
|
- if (sector == RT_NULL)
|
|
|
- {
|
|
|
- LOG_E("allocate partition sector buffer failed!");
|
|
|
|
|
|
- return -RT_ENOMEM;
|
|
|
- }
|
|
|
+ blk_dev->max_req_size = BLK_MIN((card->host->max_dma_segs *
|
|
|
+ card->host->max_seg_size) >> 9,
|
|
|
+ (card->host->max_blk_count *
|
|
|
+ card->host->max_blk_size) >> 9);
|
|
|
+ blk_dev->part.offset = 0;
|
|
|
+ blk_dev->part.size = 0;
|
|
|
+ rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,0);
|
|
|
+ blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
+ /* register mmcsd device */
|
|
|
+ blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
+#ifdef RT_USING_DEVICE_OPS
|
|
|
+ blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
+#else
|
|
|
+ blk_dev->dev.init = rt_mmcsd_init;
|
|
|
+ blk_dev->dev.open = rt_mmcsd_open;
|
|
|
+ blk_dev->dev.close = rt_mmcsd_close;
|
|
|
+ blk_dev->dev.read = rt_mmcsd_read;
|
|
|
+ blk_dev->dev.write = rt_mmcsd_write;
|
|
|
+ blk_dev->dev.control = rt_mmcsd_control;
|
|
|
+#endif
|
|
|
+ blk_dev->card = card;
|
|
|
|
|
|
- status = rt_mmcsd_req_blk(card, 0, sector, 1, 0);
|
|
|
- }
|
|
|
+ blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
+ blk_dev->geometry.block_size = card->card_blksize;
|
|
|
+ blk_dev->geometry.sector_count =
|
|
|
+ card->card_capacity * (1024 / 512);
|
|
|
|
|
|
- if (status == RT_EOK)
|
|
|
+ blk_dev->dev.user_data = blk_dev;
|
|
|
+
|
|
|
+ rt_device_register(&(blk_dev->dev), card->host->name,
|
|
|
+ RT_DEVICE_FLAG_RDWR);
|
|
|
+ rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
+
|
|
|
+ for (i = 0; i < RT_GPT_PARTITION_MAX; i++)
|
|
|
{
|
|
|
blk_dev = rt_calloc(1, sizeof(struct mmcsd_blk_device));
|
|
|
if (!blk_dev)
|
|
|
{
|
|
|
LOG_E("mmcsd:malloc memory failed!");
|
|
|
- return -1;
|
|
|
+ break;
|
|
|
}
|
|
|
-
|
|
|
blk_dev->max_req_size = BLK_MIN((card->host->max_dma_segs *
|
|
|
- card->host->max_seg_size) >> 9,
|
|
|
+ card->host->max_seg_size) >> 9,
|
|
|
(card->host->max_blk_count *
|
|
|
- card->host->max_blk_size) >> 9);
|
|
|
- blk_dev->part.offset = 0;
|
|
|
- blk_dev->part.size = 0;
|
|
|
- rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,0);
|
|
|
- blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
- /* register mmcsd device */
|
|
|
- blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
-#ifdef RT_USING_DEVICE_OPS
|
|
|
- blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
-#else
|
|
|
- blk_dev->dev.init = rt_mmcsd_init;
|
|
|
- blk_dev->dev.open = rt_mmcsd_open;
|
|
|
- blk_dev->dev.close = rt_mmcsd_close;
|
|
|
- blk_dev->dev.read = rt_mmcsd_read;
|
|
|
- blk_dev->dev.write = rt_mmcsd_write;
|
|
|
- blk_dev->dev.control = rt_mmcsd_control;
|
|
|
-#endif
|
|
|
- blk_dev->card = card;
|
|
|
-
|
|
|
- blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
- blk_dev->geometry.block_size = card->card_blksize;
|
|
|
- blk_dev->geometry.sector_count =
|
|
|
- card->card_capacity * (1024 / 512);
|
|
|
+ card->host->max_blk_size) >> 9);
|
|
|
|
|
|
- blk_dev->dev.user_data = blk_dev;
|
|
|
-
|
|
|
- rt_device_register(&(blk_dev->dev), card->host->name,
|
|
|
- RT_DEVICE_FLAG_RDWR);
|
|
|
- rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
- if (gpt_chk == 1)
|
|
|
+ /* get the first partition */
|
|
|
+ status = gpt_get_partition_param(card, &blk_dev->part, i);
|
|
|
+ if (status == RT_EOK)
|
|
|
{
|
|
|
- for (i = 0; i < 128; i++)
|
|
|
- {
|
|
|
- blk_dev = rt_calloc(1, sizeof(struct mmcsd_blk_device));
|
|
|
- if (!blk_dev)
|
|
|
- {
|
|
|
- LOG_E("mmcsd:malloc memory failed!");
|
|
|
- break;
|
|
|
- }
|
|
|
- blk_dev->max_req_size = BLK_MIN((card->host->max_dma_segs *
|
|
|
- card->host->max_seg_size) >> 9,
|
|
|
- (card->host->max_blk_count *
|
|
|
- card->host->max_blk_size) >> 9);
|
|
|
-
|
|
|
- /* get the first partition */
|
|
|
- status = get_partition_param(card, &blk_dev->part, i);
|
|
|
- if (status == RT_EOK)
|
|
|
- {
|
|
|
- rt_snprintf(dname, sizeof(dname)-1, "%s%d", card->host->name,i);
|
|
|
- rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,i+1);
|
|
|
- blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
-
|
|
|
- /* register mmcsd device */
|
|
|
- blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
+ rt_snprintf(dname, sizeof(dname)-1, "%s%d", card->host->name,i);
|
|
|
+ rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,i+1);
|
|
|
+ blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
+
|
|
|
+ /* register mmcsd device */
|
|
|
+ blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
#ifdef RT_USING_DEVICE_OPS
|
|
|
- blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
+ blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
#else
|
|
|
- blk_dev->dev.init = rt_mmcsd_init;
|
|
|
- blk_dev->dev.open = rt_mmcsd_open;
|
|
|
- blk_dev->dev.close = rt_mmcsd_close;
|
|
|
- blk_dev->dev.read = rt_mmcsd_read;
|
|
|
- blk_dev->dev.write = rt_mmcsd_write;
|
|
|
- blk_dev->dev.control = rt_mmcsd_control;
|
|
|
+ blk_dev->dev.init = rt_mmcsd_init;
|
|
|
+ blk_dev->dev.open = rt_mmcsd_open;
|
|
|
+ blk_dev->dev.close = rt_mmcsd_close;
|
|
|
+ blk_dev->dev.read = rt_mmcsd_read;
|
|
|
+ blk_dev->dev.write = rt_mmcsd_write;
|
|
|
+ blk_dev->dev.control = rt_mmcsd_control;
|
|
|
#endif
|
|
|
- blk_dev->card = card;
|
|
|
+ blk_dev->card = card;
|
|
|
|
|
|
- blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
- blk_dev->geometry.block_size = card->card_blksize;
|
|
|
- blk_dev->geometry.sector_count = blk_dev->part.size;
|
|
|
+ blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
+ blk_dev->geometry.block_size = card->card_blksize;
|
|
|
+ blk_dev->geometry.sector_count = blk_dev->part.size;
|
|
|
|
|
|
- blk_dev->dev.user_data = blk_dev;
|
|
|
-
|
|
|
- rt_device_register(&(blk_dev->dev), dname,
|
|
|
- RT_DEVICE_FLAG_RDWR);
|
|
|
- rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_free(blk_dev);
|
|
|
- blk_dev = RT_NULL;
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
-#ifdef RT_USING_DFS_MNTTABLE
|
|
|
- if (blk_dev)
|
|
|
- {
|
|
|
- LOG_I("try to mount file system!");
|
|
|
- /* try to mount file system on this block device */
|
|
|
- dfs_mount_device(&(blk_dev->dev));
|
|
|
- }
|
|
|
-#endif
|
|
|
- }
|
|
|
+ blk_dev->dev.user_data = blk_dev;
|
|
|
|
|
|
+ rt_device_register(&(blk_dev->dev), dname,
|
|
|
+ RT_DEVICE_FLAG_RDWR);
|
|
|
+ rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- for (i = 0; i < RT_MMCSD_MAX_PARTITION; i++)
|
|
|
- {
|
|
|
- blk_dev = rt_calloc(1, sizeof(struct mmcsd_blk_device));
|
|
|
- if (!blk_dev)
|
|
|
- {
|
|
|
- LOG_E("mmcsd:malloc memory failed!");
|
|
|
- break;
|
|
|
- }
|
|
|
- blk_dev->max_req_size = BLK_MIN((card->host->max_dma_segs *
|
|
|
- card->host->max_seg_size) >> 9,
|
|
|
- (card->host->max_blk_count *
|
|
|
- card->host->max_blk_size) >> 9);
|
|
|
-
|
|
|
- /* get the first partition */
|
|
|
- status = dfs_filesystem_get_partition(&blk_dev->part, sector, i);
|
|
|
- if (status == RT_EOK)
|
|
|
- {
|
|
|
- rt_snprintf(dname, sizeof(dname)-1, "%s%d", card->host->name,i);
|
|
|
- rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,i+1);
|
|
|
- blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
-
|
|
|
- /* register mmcsd device */
|
|
|
- blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
-#ifdef RT_USING_DEVICE_OPS
|
|
|
- blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
-#else
|
|
|
- blk_dev->dev.init = rt_mmcsd_init;
|
|
|
- blk_dev->dev.open = rt_mmcsd_open;
|
|
|
- blk_dev->dev.close = rt_mmcsd_close;
|
|
|
- blk_dev->dev.read = rt_mmcsd_read;
|
|
|
- blk_dev->dev.write = rt_mmcsd_write;
|
|
|
- blk_dev->dev.control = rt_mmcsd_control;
|
|
|
+ rt_free(blk_dev);
|
|
|
+ blk_dev = RT_NULL;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+#ifdef RT_USING_DFS_MNTTABLE
|
|
|
+ if (blk_dev)
|
|
|
+ {
|
|
|
+ LOG_I("try to mount file system!");
|
|
|
+ /* try to mount file system on this block device */
|
|
|
+ dfs_mount_device(&(blk_dev->dev));
|
|
|
+ }
|
|
|
#endif
|
|
|
- blk_dev->card = card;
|
|
|
+ }
|
|
|
+ gpt_free();
|
|
|
|
|
|
- blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
- blk_dev->geometry.block_size = card->card_blksize;
|
|
|
- blk_dev->geometry.sector_count = blk_dev->part.size;
|
|
|
+ return err;
|
|
|
+}
|
|
|
|
|
|
- blk_dev->dev.user_data = blk_dev;
|
|
|
+rt_int32_t mbr_device_probe(struct rt_mmcsd_card *card)
|
|
|
+{
|
|
|
+ rt_int32_t err = 0;
|
|
|
+ rt_uint8_t i, status;
|
|
|
+ rt_uint8_t *sector;
|
|
|
+ char dname[10];
|
|
|
+ char sname[16];
|
|
|
+ struct mmcsd_blk_device *blk_dev = RT_NULL;
|
|
|
|
|
|
- rt_device_register(&(blk_dev->dev), dname,
|
|
|
- RT_DEVICE_FLAG_RDWR);
|
|
|
- rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- rt_free(blk_dev);
|
|
|
- blk_dev = RT_NULL;
|
|
|
- break;
|
|
|
- }
|
|
|
+ err = mmcsd_set_blksize(card);
|
|
|
+ if(err)
|
|
|
+ {
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+ mmcsd_delay_ms(1);
|
|
|
+ /* get the first sector to read partition table */
|
|
|
+ sector = (rt_uint8_t *)rt_malloc(SECTOR_SIZE);
|
|
|
+ if (sector == RT_NULL)
|
|
|
+ {
|
|
|
+ LOG_E("allocate partition sector buffer failed!");
|
|
|
|
|
|
-#ifdef RT_USING_DFS_MNTTABLE
|
|
|
- if (blk_dev)
|
|
|
- {
|
|
|
- LOG_I("try to mount file system!");
|
|
|
- /* try to mount file system on this block device */
|
|
|
- dfs_mount_device(&(blk_dev->dev));
|
|
|
- }
|
|
|
-#endif
|
|
|
+ return -RT_ENOMEM;
|
|
|
+ }
|
|
|
+
|
|
|
+ status = rt_mmcsd_req_blk(card, 0, sector, 1, 0);
|
|
|
+ if (status == RT_EOK)
|
|
|
+ {
|
|
|
+ for (i = 0; i < RT_MMCSD_MAX_PARTITION; i++)
|
|
|
+ {
|
|
|
+ blk_dev = rt_calloc(1, sizeof(struct mmcsd_blk_device));
|
|
|
+ if (!blk_dev)
|
|
|
+ {
|
|
|
+ LOG_E("mmcsd:malloc memory failed!");
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ blk_dev->max_req_size = BLK_MIN((card->host->max_dma_segs *
|
|
|
+ card->host->max_seg_size) >> 9,
|
|
|
+ (card->host->max_blk_count *
|
|
|
+ card->host->max_blk_size) >> 9);
|
|
|
+
|
|
|
+ /* get the first partition */
|
|
|
+ status = dfs_filesystem_get_partition(&blk_dev->part, sector, i);
|
|
|
+ if (status == RT_EOK)
|
|
|
+ {
|
|
|
+ rt_snprintf(dname, sizeof(dname)-1, "%s%d", card->host->name,i);
|
|
|
+ rt_snprintf(sname, sizeof(sname)-1, "sem_%s%d", card->host->name,i+1);
|
|
|
+ blk_dev->part.lock = rt_sem_create(sname, 1, RT_IPC_FLAG_FIFO);
|
|
|
+
|
|
|
+ /* register mmcsd device */
|
|
|
+ blk_dev->dev.type = RT_Device_Class_Block;
|
|
|
+ #ifdef RT_USING_DEVICE_OPS
|
|
|
+ blk_dev->dev.ops = &mmcsd_blk_ops;
|
|
|
+ #else
|
|
|
+ blk_dev->dev.init = rt_mmcsd_init;
|
|
|
+ blk_dev->dev.open = rt_mmcsd_open;
|
|
|
+ blk_dev->dev.close = rt_mmcsd_close;
|
|
|
+ blk_dev->dev.read = rt_mmcsd_read;
|
|
|
+ blk_dev->dev.write = rt_mmcsd_write;
|
|
|
+ blk_dev->dev.control = rt_mmcsd_control;
|
|
|
+ #endif
|
|
|
+ blk_dev->card = card;
|
|
|
+
|
|
|
+ blk_dev->geometry.bytes_per_sector = 1<<9;
|
|
|
+ blk_dev->geometry.block_size = card->card_blksize;
|
|
|
+ blk_dev->geometry.sector_count = blk_dev->part.size;
|
|
|
+
|
|
|
+ blk_dev->dev.user_data = blk_dev;
|
|
|
+
|
|
|
+ rt_device_register(&(blk_dev->dev), dname,
|
|
|
+ RT_DEVICE_FLAG_RDWR);
|
|
|
+ rt_list_insert_after(&blk_devices, &blk_dev->list);
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ rt_free(blk_dev);
|
|
|
+ blk_dev = RT_NULL;
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
+ #ifdef RT_USING_DFS_MNTTABLE
|
|
|
+ if (blk_dev)
|
|
|
+ {
|
|
|
+ LOG_I("try to mount file system!");
|
|
|
+ /* try to mount file system on this block device */
|
|
|
+ dfs_mount_device(&(blk_dev->dev));
|
|
|
+ }
|
|
|
+ #endif
|
|
|
}
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
LOG_E("read mmcsd first sector failed");
|
|
|
- err = -RT_ERROR;
|
|
|
+ err = -RT_ERROR;
|
|
|
}
|
|
|
|
|
|
- if (gpt_chk == 1)
|
|
|
+ /* release sector buffer */
|
|
|
+ rt_free(sector);
|
|
|
+
|
|
|
+ return err;
|
|
|
+
|
|
|
+}
|
|
|
+
|
|
|
+rt_int32_t rt_mmcsd_blk_probe(struct rt_mmcsd_card *card)
|
|
|
+{
|
|
|
+ uint32_t err = 0;
|
|
|
+
|
|
|
+ LOG_D("probe mmcsd block device!");
|
|
|
+ if (check_gpt(card) != 0)
|
|
|
{
|
|
|
- gpt_free();
|
|
|
+ err = gpt_device_probe(card);
|
|
|
}
|
|
|
else
|
|
|
{
|
|
|
- /* release sector buffer */
|
|
|
- rt_free(sector);
|
|
|
+ err = mbr_device_probe(card);
|
|
|
}
|
|
|
-
|
|
|
return err;
|
|
|
}
|
|
|
|