123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433 |
- #include "fat_ent.h"
- #include <common/errno.h>
- #include <driver/disk/ahci/ahci.h>
- #include <mm/slab.h>
- static const char unavailable_character_in_short_name[] = {0x22, 0x2a, 0x2b, 0x2c, 0x2e, 0x2f, 0x3a, 0x3b,
- 0x3c, 0x3d, 0x3e, 0x3f, 0x5b, 0x5c, 0x5d, 0x7c};
- 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;
- struct block_device *blk = inode->sb->blk_device;
- 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);
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_READ_DMA_EXT, fsbi->FAT1_base_sector + i, 1, (uint64_t)buf);
-
- 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;
- cluster = tmp_clus;
- while (true)
- {
- tmp_clus = fat32_read_FAT_entry(blk, fsbi, cluster);
- if (tmp_clus <= 0x0ffffff7)
- cluster = tmp_clus;
- else
- break;
- }
- }
-
- for (int i = idx; i < num_clusters; ++i)
- {
-
- fat32_write_FAT_entry(blk, fsbi, cluster, clusters[i]);
- cluster = clusters[i];
- }
- fat32_write_FAT_entry(blk, fsbi, cluster, 0x0ffffff8);
- return 0;
- }
- else
- {
- kwarn("err in alloc clusters");
- 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(struct block_device *blk, 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);
-
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_READ_DMA_EXT,
- fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1, (uint64_t)&buf);
-
- return buf[cluster & (fat_ent_per_sec - 1)] & 0x0fffffff;
- }
- uint32_t fat32_write_FAT_entry(struct block_device *blk, 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 = kzalloc(fsbi->bytes_per_sec, 0);
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_READ_DMA_EXT,
- fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1, (uint64_t)buf);
- buf[cluster & (fat_ent_per_sec - 1)] = (buf[cluster & (fat_ent_per_sec - 1)] & 0xf0000000) | (value & 0x0fffffff);
-
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_WRITE_DMA_EXT,
- fsbi->FAT1_base_sector + (cluster / fat_ent_per_sec), 1, (uint64_t)buf);
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_WRITE_DMA_EXT,
- fsbi->FAT2_base_sector + (cluster / fat_ent_per_sec), 1, (uint64_t)buf);
- 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)
- {
-
- 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 = kzalloc(fsbi->bytes_per_clus, 0);
- struct block_device *blk = parent_inode->sb->blk_device;
-
- 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;
-
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_READ_DMA_EXT, sector, fsbi->sec_per_clus, (uint64_t)buf);
- 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(blk, 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 = kzalloc(fsbi->bytes_per_clus, 0);
- blk->bd_disk->fops->transfer(blk->bd_disk, AHCI_CMD_WRITE_DMA_EXT, sector, fsbi->sec_per_clus,
- (uint64_t)tmp_buf);
- kfree(tmp_buf);
- }
- }
- }
- int fat32_check_name_available(const char *name, int namelen, int8_t reserved)
- {
- if (namelen > 255 || namelen <= 0)
- return -ENAMETOOLONG;
-
- if (name[0] == 0x20 || name[0] == '.')
- return -EINVAL;
- return 0;
- }
- bool fat32_check_char_available_in_short_name(const char c, int index)
- {
-
- if (index == 0)
- {
- if (c < 0x20)
- {
- if (c != 0x05)
- return false;
- return true;
- }
- }
- for (int i = 0; i < sizeof(unavailable_character_in_short_name) / sizeof(char); ++i)
- {
- if (c == unavailable_character_in_short_name[i])
- return false;
- }
- return true;
- }
- void fat32_fill_shortname(struct vfs_dir_entry_t *dEntry, struct fat32_Directory_t *target, uint32_t cluster)
- {
- memset(target, 0, sizeof(struct fat32_Directory_t));
- {
- int tmp_index = 0;
-
- for (tmp_index = 0; tmp_index < min(8, dEntry->name_length); ++tmp_index)
- {
- if (dEntry->name[tmp_index] == '.')
- break;
- if (fat32_check_char_available_in_short_name(dEntry->name[tmp_index], tmp_index))
- target->DIR_Name[tmp_index] = dEntry->name[tmp_index];
- else
- target->DIR_Name[tmp_index] = 0x20;
- }
-
- if (tmp_index < 8 && tmp_index == dEntry->name_length)
- {
- target->DIR_Name[tmp_index] = '\0';
- ++tmp_index;
- }
-
- while (tmp_index < 8)
- {
-
- target->DIR_Name[tmp_index] = 0x20;
- ++tmp_index;
- }
- if (dEntry->dir_inode->attribute & VFS_IF_DIR)
- {
- while (tmp_index < 11)
- {
-
- target->DIR_Name[tmp_index] = 0x20;
- ++tmp_index;
- }
- }
- else
- {
- for (int j = 8; j < 11; ++j)
- {
- target->DIR_Name[j] = 'a';
- }
- }
- }
- struct vfs_index_node_t *inode = dEntry->dir_inode;
- target->DIR_Attr = 0;
- if (inode->attribute & VFS_IF_DIR)
- target->DIR_Attr |= ATTR_DIRECTORY;
- target->DIR_FileSize = dEntry->dir_inode->file_size;
- target->DIR_FstClusHI = (uint16_t)((cluster >> 16) & 0x0fff);
- target->DIR_FstClusLO = (uint16_t)(cluster & 0xffff);
-
- }
- void fat32_fill_longname(struct vfs_dir_entry_t *dEntry, struct fat32_LongDirectory_t *target, uint8_t checksum,
- uint32_t cnt_longname)
- {
- uint32_t current_name_index = 0;
- struct fat32_LongDirectory_t *Ldentry = (struct fat32_LongDirectory_t *)(target + 1);
-
- for (int i = 1; i <= cnt_longname; ++i)
- {
- --Ldentry;
- Ldentry->LDIR_Ord = i;
- for (int j = 0; j < 5; ++j, ++current_name_index)
- {
- if (current_name_index < dEntry->name_length)
- Ldentry->LDIR_Name1[j] = dEntry->name[current_name_index];
- else if (current_name_index == dEntry->name_length)
- Ldentry->LDIR_Name1[j] = '\0';
- else
- Ldentry->LDIR_Name1[j] = 0xffff;
- }
- for (int j = 0; j < 6; ++j, ++current_name_index)
- {
- if (current_name_index < dEntry->name_length)
- Ldentry->LDIR_Name2[j] = dEntry->name[current_name_index];
- else if (current_name_index == dEntry->name_length)
- Ldentry->LDIR_Name1[j] = '\0';
- else
- Ldentry->LDIR_Name2[j] = 0xffff;
- }
- for (int j = 0; j < 2; ++j, ++current_name_index)
- {
- if (current_name_index < dEntry->name_length)
- Ldentry->LDIR_Name3[j] = dEntry->name[current_name_index];
- else if (current_name_index == dEntry->name_length)
- Ldentry->LDIR_Name1[j] = '\0';
- else
- Ldentry->LDIR_Name3[j] = 0xffff;
- }
- Ldentry->LDIR_Attr = ATTR_LONG_NAME;
- Ldentry->LDIR_FstClusLO = 0;
- Ldentry->LDIR_Type = 0;
- Ldentry->LDIR_Chksum = checksum;
- }
-
- Ldentry->LDIR_Ord |= 0x40;
- }
|