123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253 |
- #include "fat_ent.h"
- #include <driver/disk/ahci/ahci.h>
- #include <common/errno.h>
- #include <mm/slab.h>
- int fat32_alloc_clusters(struct vfs_index_node_t *inode, uint32_t *clusters, int32_t num_clusters)
- {
- int retval = 0;
- fat32_sb_info_t *fsbi = (fat32_sb_info_t *)inode->sb->private_sb_info;
- struct fat32_inode_info_t *finode = (struct fat32_inode_info_t *)inode->private_inode_info;
- uint64_t sec_per_fat = fsbi->sec_per_FAT;
-
-
- uint32_t *buf = (uint32_t *)kmalloc(fsbi->bytes_per_sec, 0);
- int ent_per_sec = (fsbi->bytes_per_sec >> 2);
- int clus_idx = 0;
- for (int i = 0; i < sec_per_fat; ++i)
- {
- if (clus_idx >= num_clusters)
- goto done;
- memset(buf, 0, fsbi->bytes_per_sec);
- ahci_operation.transfer(AHCI_CMD_READ_DMA_EXT, fsbi->FAT1_base_sector + i, 1, (uint64_t)buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
-
- for (int j = 0; j < ent_per_sec; ++j)
- {
- if (clus_idx >= num_clusters)
- goto done;
-
- if ((buf[j] & 0x0fffffff) == 0)
- {
- clusters[clus_idx] = i * ent_per_sec + j;
- ++clus_idx;
- }
- }
- }
-
- retval = -ENOSPC;
- done:;
- kfree(buf);
- if (retval == 0)
- {
- int cluster, idx;
- if (finode->first_clus == 0)
- {
-
- finode->first_clus = clusters[0];
- cluster = finode->first_clus;
-
- inode->sb->sb_ops->write_inode(inode);
- idx = 1;
- }
- else
- {
-
- idx = 0;
- int tmp_clus = finode->first_clus;
- while (true)
- {
- tmp_clus = fat32_read_FAT_entry(fsbi, cluster);
- if (tmp_clus < 0x0ffffff7)
- cluster = tmp_clus;
- else
- break;
- }
- }
-
- for (int i = idx; i < num_clusters; ++i)
- {
- fat32_write_FAT_entry(fsbi, cluster, clusters[i]);
- cluster = clusters[i];
- }
- fat32_write_FAT_entry(fsbi, cluster, 0x0ffffff8);
- return 0;
- }
- else
- {
- if (clus_idx < num_clusters)
- fat32_free_clusters(inode, clusters[0]);
- return retval;
- }
- return 0;
- }
- int fat32_free_clusters(struct vfs_index_node_t *inode, int32_t cluster)
- {
-
- return 0;
- }
- uint32_t fat32_read_FAT_entry(fat32_sb_info_t *fsbi, uint32_t cluster)
- {
-
-
- uint32_t fat_ent_per_sec = (fsbi->bytes_per_sec >> 2);
- uint32_t buf[256];
- memset(buf, 0, fsbi->bytes_per_sec);
-
- ahci_operation.transfer(AHCI_CMD_READ_DMA_EXT, fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1,
- (uint64_t)&buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
-
- return buf[cluster & (fat_ent_per_sec - 1)] & 0x0fffffff;
- }
- uint32_t fat32_write_FAT_entry(fat32_sb_info_t *fsbi, uint32_t cluster, uint32_t value)
- {
-
-
- uint32_t fat_ent_per_sec = (fsbi->bytes_per_sec >> 2);
- uint32_t *buf = kmalloc(fsbi->bytes_per_sec, 0);
- memset(buf, 0, fsbi->bytes_per_sec);
- ahci_operation.transfer(AHCI_CMD_READ_DMA_EXT, fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1,
- (uint64_t)buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
- buf[cluster & (fat_ent_per_sec - 1)] = (buf[cluster & (fat_ent_per_sec - 1)] & 0xf0000000) | (value & 0x0fffffff);
-
- ahci_operation.transfer(AHCI_CMD_WRITE_DMA_EXT, fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1,
- (uint64_t)buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
- ahci_operation.transfer(AHCI_CMD_WRITE_DMA_EXT, fsbi->FAT2_base_sector + (cluster / fat_ent_per_sec), 1,
- (uint64_t)buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
- kfree(buf);
- return 0;
- }
- struct fat32_Directory_t *fat32_find_empty_dentry(struct vfs_index_node_t *parent_inode, uint32_t num, uint32_t mode, uint32_t *res_sector, uint64_t *res_cluster, uint64_t *res_data_buf_base)
- {
- kdebug("find empty_dentry");
- struct fat32_inode_info_t *finode = (struct fat32_inode_info_t *)parent_inode->private_inode_info;
- fat32_sb_info_t *fsbi = (fat32_sb_info_t *)parent_inode->sb->private_sb_info;
- uint8_t *buf = kmalloc(fsbi->bytes_per_clus, 0);
- memset(buf, 0, fsbi->bytes_per_clus);
-
- uint32_t cluster = finode->first_clus;
- struct fat32_Directory_t *tmp_dEntry = NULL;
-
- struct fat32_Directory_t *result_dEntry = NULL;
- while (true)
- {
-
- uint64_t sector = fsbi->first_data_sector + (cluster - 2) * fsbi->sec_per_clus;
-
- ahci_operation.transfer(AHCI_CMD_READ_DMA_EXT, sector, fsbi->sec_per_clus, (uint64_t)buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
- tmp_dEntry = (struct fat32_Directory_t *)buf;
-
- uint32_t count_continuity = 0;
-
- for (int i = 0; (i < fsbi->bytes_per_clus) && count_continuity < num; i += 32, ++tmp_dEntry)
- {
- if (!(tmp_dEntry->DIR_Name[0] == 0xe5 || tmp_dEntry->DIR_Name[0] == 0x00))
- {
- count_continuity = 0;
- continue;
- }
- if (count_continuity == 0)
- result_dEntry = tmp_dEntry;
- ++count_continuity;
- }
-
- if (count_continuity == num)
- {
- result_dEntry += (num - 1);
- *res_sector = sector;
- *res_data_buf_base = (uint64_t)buf;
- *res_cluster = cluster;
- return result_dEntry;
- }
-
- uint64_t old_cluster = cluster;
- cluster = fat32_read_FAT_entry(fsbi, cluster);
- if (cluster >= 0x0ffffff7)
- {
-
- if (fat32_alloc_clusters(parent_inode, &cluster, 1) != 0)
- {
- kerror("Cannot allocate a new cluster!");
- while (1)
- pause();
- }
-
- sector = fsbi->first_data_sector + (cluster - 2) * fsbi->sec_per_clus;
- void *tmp_buf = kmalloc(fsbi->bytes_per_clus, 0);
- memset(tmp_buf, 0, fsbi->bytes_per_clus);
- ahci_operation.transfer(AHCI_CMD_WRITE_DMA_EXT, sector, fsbi->sec_per_clus, (uint64_t)tmp_buf, fsbi->ahci_ctrl_num, fsbi->ahci_port_num);
- kfree(tmp_buf);
- }
- }
- }
|