1 /* vim:set shiftwidth=4 ts=8: */
3 * QEMU Block driver for virtual VFAT (shadows a local directory)
5 * Copyright (c) 2004,2005 Johannes E. Schindelin
7 * Permission is hereby granted, free of charge, to any person obtaining a copy
8 * of this software and associated documentation files (the "Software"), to deal
9 * in the Software without restriction, including without limitation the rights
10 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
11 * copies of the Software, and to permit persons to whom the Software is
12 * furnished to do so, subject to the following conditions:
14 * The above copyright notice and this permission notice shall be included in
15 * all copies or substantial portions of the Software.
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
19 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
20 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
21 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
22 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
27 #include "qemu-common.h"
28 #include "block_int.h"
30 #include "migration.h"
39 /* TODO: add ":bootsector=blabla.img:" */
40 /* LATER TODO: add automatic boot sector generation from
41 BOOTEASY.ASM and Ranish Partition Manager
42 Note that DOS assumes the system files to be the first files in the
43 file system (test if the boot sector still relies on that fact)! */
44 /* MAYBE TODO: write block-visofs.c */
45 /* TODO: call try_commit() only after a timeout */
57 static void checkpoint(void);
60 void nonono(const char* file
, int line
, const char* msg
) {
61 fprintf(stderr
, "Nonono! %s:%d %s\n", file
, line
, msg
);
65 #define assert(a) do {if (!(a)) nonono(__FILE__, __LINE__, #a);}while(0)
74 /* dynamic array functions */
75 typedef struct array_t
{
77 unsigned int size
,next
,item_size
;
80 static inline void array_init(array_t
* array
,unsigned int item_size
)
82 array
->pointer
= NULL
;
85 array
->item_size
=item_size
;
88 static inline void array_free(array_t
* array
)
90 g_free(array
->pointer
);
91 array
->size
=array
->next
=0;
94 /* does not automatically grow */
95 static inline void* array_get(array_t
* array
,unsigned int index
) {
96 assert(index
< array
->next
);
97 return array
->pointer
+ index
* array
->item_size
;
100 static inline int array_ensure_allocated(array_t
* array
, int index
)
102 if((index
+ 1) * array
->item_size
> array
->size
) {
103 int new_size
= (index
+ 32) * array
->item_size
;
104 array
->pointer
= g_realloc(array
->pointer
, new_size
);
107 array
->size
= new_size
;
108 array
->next
= index
+ 1;
114 static inline void* array_get_next(array_t
* array
) {
115 unsigned int next
= array
->next
;
118 if (array_ensure_allocated(array
, next
) < 0)
121 array
->next
= next
+ 1;
122 result
= array_get(array
, next
);
127 static inline void* array_insert(array_t
* array
,unsigned int index
,unsigned int count
) {
128 if((array
->next
+count
)*array
->item_size
>array
->size
) {
129 int increment
=count
*array
->item_size
;
130 array
->pointer
=g_realloc(array
->pointer
,array
->size
+increment
);
133 array
->size
+=increment
;
135 memmove(array
->pointer
+(index
+count
)*array
->item_size
,
136 array
->pointer
+index
*array
->item_size
,
137 (array
->next
-index
)*array
->item_size
);
139 return array
->pointer
+index
*array
->item_size
;
142 /* this performs a "roll", so that the element which was at index_from becomes
143 * index_to, but the order of all other elements is preserved. */
144 static inline int array_roll(array_t
* array
,int index_to
,int index_from
,int count
)
152 index_to
<0 || index_to
>=array
->next
||
153 index_from
<0 || index_from
>=array
->next
)
156 if(index_to
==index_from
)
160 from
=array
->pointer
+index_from
*is
;
161 to
=array
->pointer
+index_to
*is
;
162 buf
=g_malloc(is
*count
);
163 memcpy(buf
,from
,is
*count
);
165 if(index_to
<index_from
)
166 memmove(to
+is
*count
,to
,from
-to
);
168 memmove(from
,from
+is
*count
,to
-from
);
170 memcpy(to
,buf
,is
*count
);
177 static inline int array_remove_slice(array_t
* array
,int index
, int count
)
181 assert(index
+ count
<= array
->next
);
182 if(array_roll(array
,array
->next
-1,index
,count
))
184 array
->next
-= count
;
188 static int array_remove(array_t
* array
,int index
)
190 return array_remove_slice(array
, index
, 1);
193 /* return the index for a given member */
194 static int array_index(array_t
* array
, void* pointer
)
196 size_t offset
= (char*)pointer
- array
->pointer
;
197 assert((offset
% array
->item_size
) == 0);
198 assert(offset
/array
->item_size
< array
->next
);
199 return offset
/array
->item_size
;
202 /* These structures are used to fake a disk and the VFAT filesystem.
203 * For this reason we need to use QEMU_PACKED. */
205 typedef struct bootsector_t
{
208 uint16_t sector_size
;
209 uint8_t sectors_per_cluster
;
210 uint16_t reserved_sectors
;
211 uint8_t number_of_fats
;
212 uint16_t root_entries
;
213 uint16_t total_sectors16
;
215 uint16_t sectors_per_fat
;
216 uint16_t sectors_per_track
;
217 uint16_t number_of_heads
;
218 uint32_t hidden_sectors
;
219 uint32_t total_sectors
;
222 uint8_t drive_number
;
223 uint8_t current_head
;
226 uint8_t volume_label
[11];
229 uint32_t sectors_per_fat
;
232 uint32_t first_cluster_of_root_directory
;
233 uint16_t info_sector
;
234 uint16_t backup_boot_sector
;
239 uint8_t ignored
[0x1c0];
241 } QEMU_PACKED bootsector_t
;
249 typedef struct partition_t
{
250 uint8_t attributes
; /* 0x80 = bootable */
252 uint8_t fs_type
; /* 0x1 = FAT12, 0x6 = FAT16, 0xe = FAT16_LBA, 0xb = FAT32, 0xc = FAT32_LBA */
254 uint32_t start_sector_long
;
255 uint32_t length_sector_long
;
256 } QEMU_PACKED partition_t
;
258 typedef struct mbr_t
{
259 uint8_t ignored
[0x1b8];
262 partition_t partition
[4];
266 typedef struct direntry_t
{
268 uint8_t extension
[3];
279 } QEMU_PACKED direntry_t
;
281 /* this structure are used to transparently access the files */
283 typedef struct mapping_t
{
284 /* begin is the first cluster, end is the last+1 */
286 /* as s->directory is growable, no pointer may be used here */
287 unsigned int dir_index
;
288 /* the clusters of a file may be in any order; this points to the first */
289 int first_mapping_index
;
292 * - the offset in the file (in clusters) for a file, or
293 * - the next cluster of the directory for a directory, and
294 * - the address of the buffer for a faked entry
300 int parent_mapping_index
;
304 /* path contains the full path, i.e. it always starts with s->path */
307 enum { MODE_UNDEFINED
= 0, MODE_NORMAL
= 1, MODE_MODIFIED
= 2,
308 MODE_DIRECTORY
= 4, MODE_FAKED
= 8,
309 MODE_DELETED
= 16, MODE_RENAMED
= 32 } mode
;
314 static void print_direntry(const struct direntry_t
*);
315 static void print_mapping(const struct mapping_t
* mapping
);
318 /* here begins the real VVFAT driver */
320 typedef struct BDRVVVFATState
{
322 BlockDriverState
* bs
; /* pointer to parent */
323 unsigned int first_sectors_number
; /* 1 for a single partition, 0x40 for a disk with partition table */
324 unsigned char first_sectors
[0x40*0x200];
326 int fat_type
; /* 16 or 32 */
327 array_t fat
,directory
,mapping
;
329 unsigned int cluster_size
;
330 unsigned int sectors_per_cluster
;
331 unsigned int sectors_per_fat
;
332 unsigned int sectors_of_root_directory
;
333 uint32_t last_cluster_of_root_directory
;
334 unsigned int faked_sectors
; /* how many sectors are faked before file data */
335 uint32_t sector_count
; /* total number of sectors of the partition */
336 uint32_t cluster_count
; /* total number of clusters of this partition */
337 uint32_t max_fat_value
;
340 mapping_t
* current_mapping
;
341 unsigned char* cluster
; /* points to current cluster */
342 unsigned char* cluster_buffer
; /* points to a buffer to hold temp data */
343 unsigned int current_cluster
;
346 BlockDriverState
* write_target
;
348 BlockDriverState
* qcow
;
353 int downcase_short_names
;
355 Error
*migration_blocker
;
358 /* take the sector position spos and convert it to Cylinder/Head/Sector position
359 * if the position is outside the specified geometry, fill maximum value for CHS
360 * and return 1 to signal overflow.
362 static int sector2CHS(BlockDriverState
* bs
, mbr_chs_t
* chs
, int spos
){
364 sector
= spos
% (bs
->secs
); spos
/= bs
->secs
;
365 head
= spos
% (bs
->heads
); spos
/= bs
->heads
;
366 if(spos
>= bs
->cyls
){
368 it happens if 32bit sector positions are used, while CHS is only 24bit.
369 Windows/Dos is said to take 1023/255/63 as nonrepresentable CHS */
372 chs
->cylinder
= 0xFF;
375 chs
->head
= (uint8_t)head
;
376 chs
->sector
= (uint8_t)( (sector
+1) | ((spos
>>8)<<6) );
377 chs
->cylinder
= (uint8_t)spos
;
381 static void init_mbr(BDRVVVFATState
* s
)
383 /* TODO: if the files mbr.img and bootsect.img exist, use them */
384 mbr_t
* real_mbr
=(mbr_t
*)s
->first_sectors
;
385 partition_t
* partition
= &(real_mbr
->partition
[0]);
388 memset(s
->first_sectors
,0,512);
390 /* Win NT Disk Signature */
391 real_mbr
->nt_id
= cpu_to_le32(0xbe1afdfa);
393 partition
->attributes
=0x80; /* bootable */
395 /* LBA is used when partition is outside the CHS geometry */
396 lba
= sector2CHS(s
->bs
, &partition
->start_CHS
, s
->first_sectors_number
-1);
397 lba
|= sector2CHS(s
->bs
, &partition
->end_CHS
, s
->sector_count
);
399 /*LBA partitions are identified only by start/length_sector_long not by CHS*/
400 partition
->start_sector_long
=cpu_to_le32(s
->first_sectors_number
-1);
401 partition
->length_sector_long
=cpu_to_le32(s
->sector_count
- s
->first_sectors_number
+1);
403 /* FAT12/FAT16/FAT32 */
404 /* DOS uses different types when partition is LBA,
405 probably to prevent older versions from using CHS on them */
406 partition
->fs_type
= s
->fat_type
==12 ? 0x1:
407 s
->fat_type
==16 ? (lba
?0xe:0x06):
408 /*fat_tyoe==32*/ (lba
?0xc:0x0b);
410 real_mbr
->magic
[0]=0x55; real_mbr
->magic
[1]=0xaa;
413 /* direntry functions */
415 /* dest is assumed to hold 258 bytes, and pads with 0xffff up to next multiple of 26 */
416 static inline int short2long_name(char* dest
,const char* src
)
420 for(i
=0;i
<129 && src
[i
];i
++) {
425 dest
[2*i
]=dest
[2*i
+1]=0;
426 for(i
=2*i
+2;(i
%26);i
++)
431 static inline direntry_t
* create_long_filename(BDRVVVFATState
* s
,const char* filename
)
434 int length
=short2long_name(buffer
,filename
),
435 number_of_entries
=(length
+25)/26,i
;
438 for(i
=0;i
<number_of_entries
;i
++) {
439 entry
=array_get_next(&(s
->directory
));
440 entry
->attributes
=0xf;
441 entry
->reserved
[0]=0;
443 entry
->name
[0]=(number_of_entries
-i
)|(i
==0?0x40:0);
445 for(i
=0;i
<26*number_of_entries
;i
++) {
447 if(offset
<10) offset
=1+offset
;
448 else if(offset
<22) offset
=14+offset
-10;
449 else offset
=28+offset
-22;
450 entry
=array_get(&(s
->directory
),s
->directory
.next
-1-(i
/26));
451 entry
->name
[offset
]=buffer
[i
];
453 return array_get(&(s
->directory
),s
->directory
.next
-number_of_entries
);
456 static char is_free(const direntry_t
* direntry
)
458 return direntry
->name
[0]==0xe5 || direntry
->name
[0]==0x00;
461 static char is_volume_label(const direntry_t
* direntry
)
463 return direntry
->attributes
== 0x28;
466 static char is_long_name(const direntry_t
* direntry
)
468 return direntry
->attributes
== 0xf;
471 static char is_short_name(const direntry_t
* direntry
)
473 return !is_volume_label(direntry
) && !is_long_name(direntry
)
474 && !is_free(direntry
);
477 static char is_directory(const direntry_t
* direntry
)
479 return direntry
->attributes
& 0x10 && direntry
->name
[0] != 0xe5;
482 static inline char is_dot(const direntry_t
* direntry
)
484 return is_short_name(direntry
) && direntry
->name
[0] == '.';
487 static char is_file(const direntry_t
* direntry
)
489 return is_short_name(direntry
) && !is_directory(direntry
);
492 static inline uint32_t begin_of_direntry(const direntry_t
* direntry
)
494 return le16_to_cpu(direntry
->begin
)|(le16_to_cpu(direntry
->begin_hi
)<<16);
497 static inline uint32_t filesize_of_direntry(const direntry_t
* direntry
)
499 return le32_to_cpu(direntry
->size
);
502 static void set_begin_of_direntry(direntry_t
* direntry
, uint32_t begin
)
504 direntry
->begin
= cpu_to_le16(begin
& 0xffff);
505 direntry
->begin_hi
= cpu_to_le16((begin
>> 16) & 0xffff);
510 static inline uint8_t fat_chksum(const direntry_t
* entry
)
518 c
= (i
< 8) ? entry
->name
[i
] : entry
->extension
[i
-8];
519 chksum
=(((chksum
&0xfe)>>1)|((chksum
&0x01)?0x80:0)) + c
;
525 /* if return_time==0, this returns the fat_date, else the fat_time */
526 static uint16_t fat_datetime(time_t time
,int return_time
) {
529 t
=localtime(&time
); /* this is not thread safe */
533 localtime_r(&time
,t
);
536 return cpu_to_le16((t
->tm_sec
/2)|(t
->tm_min
<<5)|(t
->tm_hour
<<11));
537 return cpu_to_le16((t
->tm_mday
)|((t
->tm_mon
+1)<<5)|((t
->tm_year
-80)<<9));
540 static inline void fat_set(BDRVVVFATState
* s
,unsigned int cluster
,uint32_t value
)
542 if(s
->fat_type
==32) {
543 uint32_t* entry
=array_get(&(s
->fat
),cluster
);
544 *entry
=cpu_to_le32(value
);
545 } else if(s
->fat_type
==16) {
546 uint16_t* entry
=array_get(&(s
->fat
),cluster
);
547 *entry
=cpu_to_le16(value
&0xffff);
549 int offset
= (cluster
*3/2);
550 unsigned char* p
= array_get(&(s
->fat
), offset
);
554 p
[1] = (p
[1]&0xf0) | ((value
>>8)&0xf);
557 p
[0] = (p
[0]&0xf) | ((value
&0xf)<<4);
564 static inline uint32_t fat_get(BDRVVVFATState
* s
,unsigned int cluster
)
566 if(s
->fat_type
==32) {
567 uint32_t* entry
=array_get(&(s
->fat
),cluster
);
568 return le32_to_cpu(*entry
);
569 } else if(s
->fat_type
==16) {
570 uint16_t* entry
=array_get(&(s
->fat
),cluster
);
571 return le16_to_cpu(*entry
);
573 const uint8_t* x
=(uint8_t*)(s
->fat
.pointer
)+cluster
*3/2;
574 return ((x
[0]|(x
[1]<<8))>>(cluster
&1?4:0))&0x0fff;
578 static inline int fat_eof(BDRVVVFATState
* s
,uint32_t fat_entry
)
580 if(fat_entry
>s
->max_fat_value
-8)
585 static inline void init_fat(BDRVVVFATState
* s
)
587 if (s
->fat_type
== 12) {
588 array_init(&(s
->fat
),1);
589 array_ensure_allocated(&(s
->fat
),
590 s
->sectors_per_fat
* 0x200 * 3 / 2 - 1);
592 array_init(&(s
->fat
),(s
->fat_type
==32?4:2));
593 array_ensure_allocated(&(s
->fat
),
594 s
->sectors_per_fat
* 0x200 / s
->fat
.item_size
- 1);
596 memset(s
->fat
.pointer
,0,s
->fat
.size
);
598 switch(s
->fat_type
) {
599 case 12: s
->max_fat_value
=0xfff; break;
600 case 16: s
->max_fat_value
=0xffff; break;
601 case 32: s
->max_fat_value
=0x0fffffff; break;
602 default: s
->max_fat_value
=0; /* error... */
607 /* TODO: in create_short_filename, 0xe5->0x05 is not yet handled! */
608 /* TODO: in parse_short_filename, 0x05->0xe5 is not yet handled! */
609 static inline direntry_t
* create_short_and_long_name(BDRVVVFATState
* s
,
610 unsigned int directory_start
, const char* filename
, int is_dot
)
612 int i
,j
,long_index
=s
->directory
.next
;
613 direntry_t
* entry
= NULL
;
614 direntry_t
* entry_long
= NULL
;
617 entry
=array_get_next(&(s
->directory
));
618 memset(entry
->name
,0x20,11);
619 memcpy(entry
->name
,filename
,strlen(filename
));
623 entry_long
=create_long_filename(s
,filename
);
625 i
= strlen(filename
);
626 for(j
= i
- 1; j
>0 && filename
[j
]!='.';j
--);
632 entry
=array_get_next(&(s
->directory
));
633 memset(entry
->name
,0x20,11);
634 memcpy(entry
->name
, filename
, i
);
637 for (i
= 0; i
< 3 && filename
[j
+1+i
]; i
++)
638 entry
->extension
[i
] = filename
[j
+1+i
];
640 /* upcase & remove unwanted characters */
642 if(i
==10 || i
==7) for(;i
>0 && entry
->name
[i
]==' ';i
--);
643 if(entry
->name
[i
]<=' ' || entry
->name
[i
]>0x7f
644 || strchr(".*?<>|\":/\\[];,+='",entry
->name
[i
]))
646 else if(entry
->name
[i
]>='a' && entry
->name
[i
]<='z')
647 entry
->name
[i
]+='A'-'a';
650 /* mangle duplicates */
652 direntry_t
* entry1
=array_get(&(s
->directory
),directory_start
);
655 for(;entry1
<entry
;entry1
++)
656 if(!is_long_name(entry1
) && !memcmp(entry1
->name
,entry
->name
,11))
657 break; /* found dupe */
658 if(entry1
==entry
) /* no dupe found */
661 /* use all 8 characters of name */
662 if(entry
->name
[7]==' ') {
664 for(j
=6;j
>0 && entry
->name
[j
]==' ';j
--)
668 /* increment number */
669 for(j
=7;j
>0 && entry
->name
[j
]=='9';j
--)
672 if(entry
->name
[j
]<'0' || entry
->name
[j
]>'9')
679 /* calculate checksum; propagate to long name */
681 uint8_t chksum
=fat_chksum(entry
);
683 /* calculate anew, because realloc could have taken place */
684 entry_long
=array_get(&(s
->directory
),long_index
);
685 while(entry_long
<entry
&& is_long_name(entry_long
)) {
686 entry_long
->reserved
[1]=chksum
;
695 * Read a directory. (the index of the corresponding mapping must be passed).
697 static int read_directory(BDRVVVFATState
* s
, int mapping_index
)
699 mapping_t
* mapping
= array_get(&(s
->mapping
), mapping_index
);
700 direntry_t
* direntry
;
701 const char* dirname
= mapping
->path
;
702 int first_cluster
= mapping
->begin
;
703 int parent_index
= mapping
->info
.dir
.parent_mapping_index
;
704 mapping_t
* parent_mapping
= (mapping_t
*)
705 (parent_index
>= 0 ? array_get(&(s
->mapping
), parent_index
) : NULL
);
706 int first_cluster_of_parent
= parent_mapping
? parent_mapping
->begin
: -1;
708 DIR* dir
=opendir(dirname
);
709 struct dirent
* entry
;
712 assert(mapping
->mode
& MODE_DIRECTORY
);
715 mapping
->end
= mapping
->begin
;
719 i
= mapping
->info
.dir
.first_dir_index
=
720 first_cluster
== 0 ? 0 : s
->directory
.next
;
722 /* actually read the directory, and allocate the mappings */
723 while((entry
=readdir(dir
))) {
724 unsigned int length
=strlen(dirname
)+2+strlen(entry
->d_name
);
726 direntry_t
* direntry
;
728 int is_dot
=!strcmp(entry
->d_name
,".");
729 int is_dotdot
=!strcmp(entry
->d_name
,"..");
731 if(first_cluster
== 0 && (is_dotdot
|| is_dot
))
734 buffer
=(char*)g_malloc(length
);
735 snprintf(buffer
,length
,"%s/%s",dirname
,entry
->d_name
);
737 if(stat(buffer
,&st
)<0) {
742 /* create directory entry for this file */
743 direntry
=create_short_and_long_name(s
, i
, entry
->d_name
,
744 is_dot
|| is_dotdot
);
745 direntry
->attributes
=(S_ISDIR(st
.st_mode
)?0x10:0x20);
746 direntry
->reserved
[0]=direntry
->reserved
[1]=0;
747 direntry
->ctime
=fat_datetime(st
.st_ctime
,1);
748 direntry
->cdate
=fat_datetime(st
.st_ctime
,0);
749 direntry
->adate
=fat_datetime(st
.st_atime
,0);
750 direntry
->begin_hi
=0;
751 direntry
->mtime
=fat_datetime(st
.st_mtime
,1);
752 direntry
->mdate
=fat_datetime(st
.st_mtime
,0);
754 set_begin_of_direntry(direntry
, first_cluster_of_parent
);
756 set_begin_of_direntry(direntry
, first_cluster
);
758 direntry
->begin
=0; /* do that later */
759 if (st
.st_size
> 0x7fffffff) {
760 fprintf(stderr
, "File %s is larger than 2GB\n", buffer
);
765 direntry
->size
=cpu_to_le32(S_ISDIR(st
.st_mode
)?0:st
.st_size
);
767 /* create mapping for this file */
768 if(!is_dot
&& !is_dotdot
&& (S_ISDIR(st
.st_mode
) || st
.st_size
)) {
769 s
->current_mapping
=(mapping_t
*)array_get_next(&(s
->mapping
));
770 s
->current_mapping
->begin
=0;
771 s
->current_mapping
->end
=st
.st_size
;
773 * we get the direntry of the most recent direntry, which
774 * contains the short name and all the relevant information.
776 s
->current_mapping
->dir_index
=s
->directory
.next
-1;
777 s
->current_mapping
->first_mapping_index
= -1;
778 if (S_ISDIR(st
.st_mode
)) {
779 s
->current_mapping
->mode
= MODE_DIRECTORY
;
780 s
->current_mapping
->info
.dir
.parent_mapping_index
=
783 s
->current_mapping
->mode
= MODE_UNDEFINED
;
784 s
->current_mapping
->info
.file
.offset
= 0;
786 s
->current_mapping
->path
=buffer
;
787 s
->current_mapping
->read_only
=
788 (st
.st_mode
& (S_IWUSR
| S_IWGRP
| S_IWOTH
)) == 0;
793 /* fill with zeroes up to the end of the cluster */
794 while(s
->directory
.next
%(0x10*s
->sectors_per_cluster
)) {
795 direntry_t
* direntry
=array_get_next(&(s
->directory
));
796 memset(direntry
,0,sizeof(direntry_t
));
799 /* TODO: if there are more entries, bootsector has to be adjusted! */
800 #define ROOT_ENTRIES (0x02 * 0x10 * s->sectors_per_cluster)
801 if (mapping_index
== 0 && s
->directory
.next
< ROOT_ENTRIES
) {
803 int cur
= s
->directory
.next
;
804 array_ensure_allocated(&(s
->directory
), ROOT_ENTRIES
- 1);
805 s
->directory
.next
= ROOT_ENTRIES
;
806 memset(array_get(&(s
->directory
), cur
), 0,
807 (ROOT_ENTRIES
- cur
) * sizeof(direntry_t
));
810 /* reget the mapping, since s->mapping was possibly realloc()ed */
811 mapping
= (mapping_t
*)array_get(&(s
->mapping
), mapping_index
);
812 first_cluster
+= (s
->directory
.next
- mapping
->info
.dir
.first_dir_index
)
813 * 0x20 / s
->cluster_size
;
814 mapping
->end
= first_cluster
;
816 direntry
= (direntry_t
*)array_get(&(s
->directory
), mapping
->dir_index
);
817 set_begin_of_direntry(direntry
, mapping
->begin
);
822 static inline uint32_t sector2cluster(BDRVVVFATState
* s
,off_t sector_num
)
824 return (sector_num
-s
->faked_sectors
)/s
->sectors_per_cluster
;
827 static inline off_t
cluster2sector(BDRVVVFATState
* s
, uint32_t cluster_num
)
829 return s
->faked_sectors
+ s
->sectors_per_cluster
* cluster_num
;
832 static int init_directories(BDRVVVFATState
* s
,
835 bootsector_t
* bootsector
;
838 unsigned int cluster
;
840 memset(&(s
->first_sectors
[0]),0,0x40*0x200);
842 s
->cluster_size
=s
->sectors_per_cluster
*0x200;
843 s
->cluster_buffer
=g_malloc(s
->cluster_size
);
846 * The formula: sc = spf+1+spf*spc*(512*8/fat_type),
847 * where sc is sector_count,
848 * spf is sectors_per_fat,
849 * spc is sectors_per_clusters, and
850 * fat_type = 12, 16 or 32.
852 i
= 1+s
->sectors_per_cluster
*0x200*8/s
->fat_type
;
853 s
->sectors_per_fat
=(s
->sector_count
+i
)/i
; /* round up */
855 array_init(&(s
->mapping
),sizeof(mapping_t
));
856 array_init(&(s
->directory
),sizeof(direntry_t
));
858 /* add volume label */
860 direntry_t
* entry
=array_get_next(&(s
->directory
));
861 entry
->attributes
=0x28; /* archive | volume label */
862 memcpy(entry
->name
,"QEMU VVF",8);
863 memcpy(entry
->extension
,"AT ",3);
866 /* Now build FAT, and write back information into directory */
869 s
->faked_sectors
=s
->first_sectors_number
+s
->sectors_per_fat
*2;
870 s
->cluster_count
=sector2cluster(s
, s
->sector_count
);
872 mapping
= array_get_next(&(s
->mapping
));
874 mapping
->dir_index
= 0;
875 mapping
->info
.dir
.parent_mapping_index
= -1;
876 mapping
->first_mapping_index
= -1;
877 mapping
->path
= g_strdup(dirname
);
878 i
= strlen(mapping
->path
);
879 if (i
> 0 && mapping
->path
[i
- 1] == '/')
880 mapping
->path
[i
- 1] = '\0';
881 mapping
->mode
= MODE_DIRECTORY
;
882 mapping
->read_only
= 0;
883 s
->path
= mapping
->path
;
885 for (i
= 0, cluster
= 0; i
< s
->mapping
.next
; i
++) {
886 /* MS-DOS expects the FAT to be 0 for the root directory
887 * (except for the media byte). */
888 /* LATER TODO: still true for FAT32? */
889 int fix_fat
= (i
!= 0);
890 mapping
= array_get(&(s
->mapping
), i
);
892 if (mapping
->mode
& MODE_DIRECTORY
) {
893 mapping
->begin
= cluster
;
894 if(read_directory(s
, i
)) {
895 fprintf(stderr
, "Could not read directory %s\n",
899 mapping
= array_get(&(s
->mapping
), i
);
901 assert(mapping
->mode
== MODE_UNDEFINED
);
902 mapping
->mode
=MODE_NORMAL
;
903 mapping
->begin
= cluster
;
904 if (mapping
->end
> 0) {
905 direntry_t
* direntry
= array_get(&(s
->directory
),
908 mapping
->end
= cluster
+ 1 + (mapping
->end
-1)/s
->cluster_size
;
909 set_begin_of_direntry(direntry
, mapping
->begin
);
911 mapping
->end
= cluster
+ 1;
916 assert(mapping
->begin
< mapping
->end
);
918 /* next free cluster */
919 cluster
= mapping
->end
;
921 if(cluster
> s
->cluster_count
) {
922 fprintf(stderr
,"Directory does not fit in FAT%d (capacity %.2f MB)\n",
923 s
->fat_type
, s
->sector_count
/ 2000.0);
927 /* fix fat for entry */
930 for(j
= mapping
->begin
; j
< mapping
->end
- 1; j
++)
932 fat_set(s
, mapping
->end
- 1, s
->max_fat_value
);
936 mapping
= array_get(&(s
->mapping
), 0);
937 s
->sectors_of_root_directory
= mapping
->end
* s
->sectors_per_cluster
;
938 s
->last_cluster_of_root_directory
= mapping
->end
;
940 /* the FAT signature */
941 fat_set(s
,0,s
->max_fat_value
);
942 fat_set(s
,1,s
->max_fat_value
);
944 s
->current_mapping
= NULL
;
946 bootsector
=(bootsector_t
*)(s
->first_sectors
+(s
->first_sectors_number
-1)*0x200);
947 bootsector
->jump
[0]=0xeb;
948 bootsector
->jump
[1]=0x3e;
949 bootsector
->jump
[2]=0x90;
950 memcpy(bootsector
->name
,"QEMU ",8);
951 bootsector
->sector_size
=cpu_to_le16(0x200);
952 bootsector
->sectors_per_cluster
=s
->sectors_per_cluster
;
953 bootsector
->reserved_sectors
=cpu_to_le16(1);
954 bootsector
->number_of_fats
=0x2; /* number of FATs */
955 bootsector
->root_entries
=cpu_to_le16(s
->sectors_of_root_directory
*0x10);
956 bootsector
->total_sectors16
=s
->sector_count
>0xffff?0:cpu_to_le16(s
->sector_count
);
957 bootsector
->media_type
=(s
->first_sectors_number
>1?0xf8:0xf0); /* media descriptor (f8=hd, f0=3.5 fd)*/
958 s
->fat
.pointer
[0] = bootsector
->media_type
;
959 bootsector
->sectors_per_fat
=cpu_to_le16(s
->sectors_per_fat
);
960 bootsector
->sectors_per_track
=cpu_to_le16(s
->bs
->secs
);
961 bootsector
->number_of_heads
=cpu_to_le16(s
->bs
->heads
);
962 bootsector
->hidden_sectors
=cpu_to_le32(s
->first_sectors_number
==1?0:0x3f);
963 bootsector
->total_sectors
=cpu_to_le32(s
->sector_count
>0xffff?s
->sector_count
:0);
965 /* LATER TODO: if FAT32, this is wrong */
966 bootsector
->u
.fat16
.drive_number
=s
->first_sectors_number
==1?0:0x80; /* fda=0, hda=0x80 */
967 bootsector
->u
.fat16
.current_head
=0;
968 bootsector
->u
.fat16
.signature
=0x29;
969 bootsector
->u
.fat16
.id
=cpu_to_le32(0xfabe1afd);
971 memcpy(bootsector
->u
.fat16
.volume_label
,"QEMU VVFAT ",11);
972 memcpy(bootsector
->fat_type
,(s
->fat_type
==12?"FAT12 ":s
->fat_type
==16?"FAT16 ":"FAT32 "),8);
973 bootsector
->magic
[0]=0x55; bootsector
->magic
[1]=0xaa;
979 static BDRVVVFATState
*vvv
= NULL
;
982 static int enable_write_target(BDRVVVFATState
*s
);
983 static int is_consistent(BDRVVVFATState
*s
);
985 static void vvfat_rebind(BlockDriverState
*bs
)
987 BDRVVVFATState
*s
= bs
->opaque
;
991 static int vvfat_open(BlockDriverState
*bs
, const char* dirname
, int flags
)
993 BDRVVVFATState
*s
= bs
->opaque
;
1000 DLOG(if (stderr
== NULL
) {
1001 stderr
= fopen("vvfat.log", "a");
1002 setbuf(stderr
, NULL
);
1007 /* LATER TODO: if FAT32, adjust */
1008 s
->sectors_per_cluster
=0x10;
1010 s
->current_cluster
=0xffffffff;
1012 s
->first_sectors_number
=0x40;
1013 /* read only is the default for safety */
1015 s
->qcow
= s
->write_target
= NULL
;
1016 s
->qcow_filename
= NULL
;
1018 s
->downcase_short_names
= 1;
1020 if (!strstart(dirname
, "fat:", NULL
))
1023 if (strstr(dirname
, ":32:")) {
1024 fprintf(stderr
, "Big fat greek warning: FAT32 has not been tested. You are welcome to do so!\n");
1026 } else if (strstr(dirname
, ":16:")) {
1028 } else if (strstr(dirname
, ":12:")) {
1032 if (strstr(dirname
, ":floppy:")) {
1033 /* 1.44MB or 2.88MB floppy. 2.88MB can be FAT12 (default) or FAT16. */
1037 s
->sectors_per_cluster
=2;
1039 bs
->secs
=(s
->fat_type
== 12 ? 18 : 36);
1040 s
->sectors_per_cluster
=1;
1042 s
->first_sectors_number
= 1;
1043 bs
->cyls
=80; bs
->heads
=2;
1045 /* 32MB or 504MB disk*/
1049 bs
->cyls
=(s
->fat_type
== 12 ? 64 : 1024);
1050 bs
->heads
=16; bs
->secs
=63;
1053 s
->sector_count
=bs
->cyls
*bs
->heads
*bs
->secs
-(s
->first_sectors_number
-1);
1055 if (strstr(dirname
, ":rw:")) {
1056 if (enable_write_target(s
))
1061 i
= strrchr(dirname
, ':') - dirname
;
1063 if (dirname
[i
-2] == ':' && qemu_isalpha(dirname
[i
-1]))
1064 /* workaround for DOS drive names */
1069 bs
->total_sectors
=bs
->cyls
*bs
->heads
*bs
->secs
;
1071 if(init_directories(s
, dirname
))
1074 s
->sector_count
= s
->faked_sectors
+ s
->sectors_per_cluster
*s
->cluster_count
;
1076 if(s
->first_sectors_number
==0x40)
1079 /* MS-DOS does not like to know about CHS (?). */
1080 bs
->heads
= bs
->cyls
= bs
->secs
= 0;
1083 // assert(is_consistent(s));
1084 qemu_co_mutex_init(&s
->lock
);
1086 /* Disable migration when vvfat is used rw */
1088 error_set(&s
->migration_blocker
,
1089 QERR_BLOCK_FORMAT_FEATURE_NOT_SUPPORTED
,
1090 "vvfat (rw)", bs
->device_name
, "live migration");
1091 migrate_add_blocker(s
->migration_blocker
);
1097 static inline void vvfat_close_current_file(BDRVVVFATState
*s
)
1099 if(s
->current_mapping
) {
1100 s
->current_mapping
= NULL
;
1101 if (s
->current_fd
) {
1102 close(s
->current_fd
);
1106 s
->current_cluster
= -1;
1109 /* mappings between index1 and index2-1 are supposed to be ordered
1110 * return value is the index of the last mapping for which end>cluster_num
1112 static inline int find_mapping_for_cluster_aux(BDRVVVFATState
* s
,int cluster_num
,int index1
,int index2
)
1117 index3
=(index1
+index2
)/2;
1118 mapping
=array_get(&(s
->mapping
),index3
);
1119 assert(mapping
->begin
< mapping
->end
);
1120 if(mapping
->begin
>=cluster_num
) {
1121 assert(index2
!=index3
|| index2
==0);
1127 return mapping
->end
<=cluster_num
? index2
: index1
;
1130 assert(index1
<=index2
);
1131 DLOG(mapping
=array_get(&(s
->mapping
),index1
);
1132 assert(mapping
->begin
<=cluster_num
);
1133 assert(index2
>= s
->mapping
.next
||
1134 ((mapping
= array_get(&(s
->mapping
),index2
)) &&
1135 mapping
->end
>cluster_num
)));
1139 static inline mapping_t
* find_mapping_for_cluster(BDRVVVFATState
* s
,int cluster_num
)
1141 int index
=find_mapping_for_cluster_aux(s
,cluster_num
,0,s
->mapping
.next
);
1143 if(index
>=s
->mapping
.next
)
1145 mapping
=array_get(&(s
->mapping
),index
);
1146 if(mapping
->begin
>cluster_num
)
1148 assert(mapping
->begin
<=cluster_num
&& mapping
->end
>cluster_num
);
1152 static int open_file(BDRVVVFATState
* s
,mapping_t
* mapping
)
1156 if(!s
->current_mapping
||
1157 strcmp(s
->current_mapping
->path
,mapping
->path
)) {
1159 int fd
= open(mapping
->path
, O_RDONLY
| O_BINARY
| O_LARGEFILE
);
1162 vvfat_close_current_file(s
);
1164 s
->current_mapping
= mapping
;
1169 static inline int read_cluster(BDRVVVFATState
*s
,int cluster_num
)
1171 if(s
->current_cluster
!= cluster_num
) {
1174 assert(!s
->current_mapping
|| s
->current_fd
|| (s
->current_mapping
->mode
& MODE_DIRECTORY
));
1175 if(!s
->current_mapping
1176 || s
->current_mapping
->begin
>cluster_num
1177 || s
->current_mapping
->end
<=cluster_num
) {
1178 /* binary search of mappings for file */
1179 mapping_t
* mapping
=find_mapping_for_cluster(s
,cluster_num
);
1181 assert(!mapping
|| (cluster_num
>=mapping
->begin
&& cluster_num
<mapping
->end
));
1183 if (mapping
&& mapping
->mode
& MODE_DIRECTORY
) {
1184 vvfat_close_current_file(s
);
1185 s
->current_mapping
= mapping
;
1186 read_cluster_directory
:
1187 offset
= s
->cluster_size
*(cluster_num
-s
->current_mapping
->begin
);
1188 s
->cluster
= (unsigned char*)s
->directory
.pointer
+offset
1189 + 0x20*s
->current_mapping
->info
.dir
.first_dir_index
;
1190 assert(((s
->cluster
-(unsigned char*)s
->directory
.pointer
)%s
->cluster_size
)==0);
1191 assert((char*)s
->cluster
+s
->cluster_size
<= s
->directory
.pointer
+s
->directory
.next
*s
->directory
.item_size
);
1192 s
->current_cluster
= cluster_num
;
1196 if(open_file(s
,mapping
))
1198 } else if (s
->current_mapping
->mode
& MODE_DIRECTORY
)
1199 goto read_cluster_directory
;
1201 assert(s
->current_fd
);
1203 offset
=s
->cluster_size
*(cluster_num
-s
->current_mapping
->begin
)+s
->current_mapping
->info
.file
.offset
;
1204 if(lseek(s
->current_fd
, offset
, SEEK_SET
)!=offset
)
1206 s
->cluster
=s
->cluster_buffer
;
1207 result
=read(s
->current_fd
,s
->cluster
,s
->cluster_size
);
1209 s
->current_cluster
= -1;
1212 s
->current_cluster
= cluster_num
;
1218 static void print_direntry(const direntry_t
* direntry
)
1223 fprintf(stderr
, "direntry %p: ", direntry
);
1226 if(is_long_name(direntry
)) {
1227 unsigned char* c
=(unsigned char*)direntry
;
1229 for(i
=1;i
<11 && c
[i
] && c
[i
]!=0xff;i
+=2)
1230 #define ADD_CHAR(c) {buffer[j] = (c); if (buffer[j] < ' ') buffer[j] = 0xb0; j++;}
1232 for(i
=14;i
<26 && c
[i
] && c
[i
]!=0xff;i
+=2)
1234 for(i
=28;i
<32 && c
[i
] && c
[i
]!=0xff;i
+=2)
1237 fprintf(stderr
, "%s\n", buffer
);
1241 ADD_CHAR(direntry
->name
[i
]);
1243 fprintf(stderr
,"%s attributes=0x%02x begin=%d size=%d\n",
1245 direntry
->attributes
,
1246 begin_of_direntry(direntry
),le32_to_cpu(direntry
->size
));
1250 static void print_mapping(const mapping_t
* mapping
)
1252 fprintf(stderr
, "mapping (%p): begin, end = %d, %d, dir_index = %d, "
1253 "first_mapping_index = %d, name = %s, mode = 0x%x, " ,
1254 mapping
, mapping
->begin
, mapping
->end
, mapping
->dir_index
,
1255 mapping
->first_mapping_index
, mapping
->path
, mapping
->mode
);
1257 if (mapping
->mode
& MODE_DIRECTORY
)
1258 fprintf(stderr
, "parent_mapping_index = %d, first_dir_index = %d\n", mapping
->info
.dir
.parent_mapping_index
, mapping
->info
.dir
.first_dir_index
);
1260 fprintf(stderr
, "offset = %d\n", mapping
->info
.file
.offset
);
1264 static int vvfat_read(BlockDriverState
*bs
, int64_t sector_num
,
1265 uint8_t *buf
, int nb_sectors
)
1267 BDRVVVFATState
*s
= bs
->opaque
;
1270 for(i
=0;i
<nb_sectors
;i
++,sector_num
++) {
1271 if (sector_num
>= bs
->total_sectors
)
1275 if (bdrv_is_allocated(s
->qcow
, sector_num
, nb_sectors
-i
, &n
)) {
1276 DLOG(fprintf(stderr
, "sectors %d+%d allocated\n", (int)sector_num
, n
));
1277 if (bdrv_read(s
->qcow
, sector_num
, buf
+ i
*0x200, n
)) {
1281 sector_num
+= n
- 1;
1284 DLOG(fprintf(stderr
, "sector %d not allocated\n", (int)sector_num
));
1286 if(sector_num
<s
->faked_sectors
) {
1287 if(sector_num
<s
->first_sectors_number
)
1288 memcpy(buf
+i
*0x200,&(s
->first_sectors
[sector_num
*0x200]),0x200);
1289 else if(sector_num
-s
->first_sectors_number
<s
->sectors_per_fat
)
1290 memcpy(buf
+i
*0x200,&(s
->fat
.pointer
[(sector_num
-s
->first_sectors_number
)*0x200]),0x200);
1291 else if(sector_num
-s
->first_sectors_number
-s
->sectors_per_fat
<s
->sectors_per_fat
)
1292 memcpy(buf
+i
*0x200,&(s
->fat
.pointer
[(sector_num
-s
->first_sectors_number
-s
->sectors_per_fat
)*0x200]),0x200);
1294 uint32_t sector
=sector_num
-s
->faked_sectors
,
1295 sector_offset_in_cluster
=(sector
%s
->sectors_per_cluster
),
1296 cluster_num
=sector
/s
->sectors_per_cluster
;
1297 if(cluster_num
> s
->cluster_count
|| read_cluster(s
, cluster_num
) != 0) {
1298 /* LATER TODO: strict: return -1; */
1299 memset(buf
+i
*0x200,0,0x200);
1302 memcpy(buf
+i
*0x200,s
->cluster
+sector_offset_in_cluster
*0x200,0x200);
1308 static coroutine_fn
int vvfat_co_read(BlockDriverState
*bs
, int64_t sector_num
,
1309 uint8_t *buf
, int nb_sectors
)
1312 BDRVVVFATState
*s
= bs
->opaque
;
1313 qemu_co_mutex_lock(&s
->lock
);
1314 ret
= vvfat_read(bs
, sector_num
, buf
, nb_sectors
);
1315 qemu_co_mutex_unlock(&s
->lock
);
1319 /* LATER TODO: statify all functions */
1322 * Idea of the write support (use snapshot):
1324 * 1. check if all data is consistent, recording renames, modifications,
1325 * new files and directories (in s->commits).
1327 * 2. if the data is not consistent, stop committing
1329 * 3. handle renames, and create new files and directories (do not yet
1330 * write their contents)
1332 * 4. walk the directories, fixing the mapping and direntries, and marking
1333 * the handled mappings as not deleted
1335 * 5. commit the contents of the files
1337 * 6. handle deleted files and directories
1341 typedef struct commit_t
{
1344 struct { uint32_t cluster
; } rename
;
1345 struct { int dir_index
; uint32_t modified_offset
; } writeout
;
1346 struct { uint32_t first_cluster
; } new_file
;
1347 struct { uint32_t cluster
; } mkdir
;
1349 /* DELETEs and RMDIRs are handled differently: see handle_deletes() */
1351 ACTION_RENAME
, ACTION_WRITEOUT
, ACTION_NEW_FILE
, ACTION_MKDIR
1355 static void clear_commits(BDRVVVFATState
* s
)
1358 DLOG(fprintf(stderr
, "clear_commits (%d commits)\n", s
->commits
.next
));
1359 for (i
= 0; i
< s
->commits
.next
; i
++) {
1360 commit_t
* commit
= array_get(&(s
->commits
), i
);
1361 assert(commit
->path
|| commit
->action
== ACTION_WRITEOUT
);
1362 if (commit
->action
!= ACTION_WRITEOUT
) {
1363 assert(commit
->path
);
1364 g_free(commit
->path
);
1366 assert(commit
->path
== NULL
);
1368 s
->commits
.next
= 0;
1371 static void schedule_rename(BDRVVVFATState
* s
,
1372 uint32_t cluster
, char* new_path
)
1374 commit_t
* commit
= array_get_next(&(s
->commits
));
1375 commit
->path
= new_path
;
1376 commit
->param
.rename
.cluster
= cluster
;
1377 commit
->action
= ACTION_RENAME
;
1380 static void schedule_writeout(BDRVVVFATState
* s
,
1381 int dir_index
, uint32_t modified_offset
)
1383 commit_t
* commit
= array_get_next(&(s
->commits
));
1384 commit
->path
= NULL
;
1385 commit
->param
.writeout
.dir_index
= dir_index
;
1386 commit
->param
.writeout
.modified_offset
= modified_offset
;
1387 commit
->action
= ACTION_WRITEOUT
;
1390 static void schedule_new_file(BDRVVVFATState
* s
,
1391 char* path
, uint32_t first_cluster
)
1393 commit_t
* commit
= array_get_next(&(s
->commits
));
1394 commit
->path
= path
;
1395 commit
->param
.new_file
.first_cluster
= first_cluster
;
1396 commit
->action
= ACTION_NEW_FILE
;
1399 static void schedule_mkdir(BDRVVVFATState
* s
, uint32_t cluster
, char* path
)
1401 commit_t
* commit
= array_get_next(&(s
->commits
));
1402 commit
->path
= path
;
1403 commit
->param
.mkdir
.cluster
= cluster
;
1404 commit
->action
= ACTION_MKDIR
;
1409 * Since the sequence number is at most 0x3f, and the filename
1410 * length is at most 13 times the sequence number, the maximal
1411 * filename length is 0x3f * 13 bytes.
1413 unsigned char name
[0x3f * 13 + 1];
1415 int sequence_number
;
1418 static void lfn_init(long_file_name
* lfn
)
1420 lfn
->sequence_number
= lfn
->len
= 0;
1421 lfn
->checksum
= 0x100;
1424 /* return 0 if parsed successfully, > 0 if no long name, < 0 if error */
1425 static int parse_long_name(long_file_name
* lfn
,
1426 const direntry_t
* direntry
)
1429 const unsigned char* pointer
= (const unsigned char*)direntry
;
1431 if (!is_long_name(direntry
))
1434 if (pointer
[0] & 0x40) {
1435 lfn
->sequence_number
= pointer
[0] & 0x3f;
1436 lfn
->checksum
= pointer
[13];
1438 lfn
->name
[lfn
->sequence_number
* 13] = 0;
1439 } else if ((pointer
[0] & 0x3f) != --lfn
->sequence_number
)
1441 else if (pointer
[13] != lfn
->checksum
)
1443 else if (pointer
[12] || pointer
[26] || pointer
[27])
1446 offset
= 13 * (lfn
->sequence_number
- 1);
1447 for (i
= 0, j
= 1; i
< 13; i
++, j
+=2) {
1453 if (pointer
[j
+1] == 0)
1454 lfn
->name
[offset
+ i
] = pointer
[j
];
1455 else if (pointer
[j
+1] != 0xff || (pointer
[0] & 0x40) == 0)
1458 lfn
->name
[offset
+ i
] = 0;
1461 if (pointer
[0] & 0x40)
1462 lfn
->len
= offset
+ strlen((char*)lfn
->name
+ offset
);
1467 /* returns 0 if successful, >0 if no short_name, and <0 on error */
1468 static int parse_short_name(BDRVVVFATState
* s
,
1469 long_file_name
* lfn
, direntry_t
* direntry
)
1473 if (!is_short_name(direntry
))
1476 for (j
= 7; j
>= 0 && direntry
->name
[j
] == ' '; j
--);
1477 for (i
= 0; i
<= j
; i
++) {
1478 if (direntry
->name
[i
] <= ' ' || direntry
->name
[i
] > 0x7f)
1480 else if (s
->downcase_short_names
)
1481 lfn
->name
[i
] = qemu_tolower(direntry
->name
[i
]);
1483 lfn
->name
[i
] = direntry
->name
[i
];
1486 for (j
= 2; j
>= 0 && direntry
->extension
[j
] == ' '; j
--);
1488 lfn
->name
[i
++] = '.';
1489 lfn
->name
[i
+ j
+ 1] = '\0';
1490 for (;j
>= 0; j
--) {
1491 if (direntry
->extension
[j
] <= ' ' || direntry
->extension
[j
] > 0x7f)
1493 else if (s
->downcase_short_names
)
1494 lfn
->name
[i
+ j
] = qemu_tolower(direntry
->extension
[j
]);
1496 lfn
->name
[i
+ j
] = direntry
->extension
[j
];
1499 lfn
->name
[i
+ j
+ 1] = '\0';
1501 lfn
->len
= strlen((char*)lfn
->name
);
1506 static inline uint32_t modified_fat_get(BDRVVVFATState
* s
,
1507 unsigned int cluster
)
1509 if (cluster
< s
->last_cluster_of_root_directory
) {
1510 if (cluster
+ 1 == s
->last_cluster_of_root_directory
)
1511 return s
->max_fat_value
;
1516 if (s
->fat_type
==32) {
1517 uint32_t* entry
=((uint32_t*)s
->fat2
)+cluster
;
1518 return le32_to_cpu(*entry
);
1519 } else if (s
->fat_type
==16) {
1520 uint16_t* entry
=((uint16_t*)s
->fat2
)+cluster
;
1521 return le16_to_cpu(*entry
);
1523 const uint8_t* x
=s
->fat2
+cluster
*3/2;
1524 return ((x
[0]|(x
[1]<<8))>>(cluster
&1?4:0))&0x0fff;
1528 static inline int cluster_was_modified(BDRVVVFATState
* s
, uint32_t cluster_num
)
1530 int was_modified
= 0;
1533 if (s
->qcow
== NULL
)
1536 for (i
= 0; !was_modified
&& i
< s
->sectors_per_cluster
; i
++)
1537 was_modified
= bdrv_is_allocated(s
->qcow
,
1538 cluster2sector(s
, cluster_num
) + i
, 1, &dummy
);
1540 return was_modified
;
1543 static const char* get_basename(const char* path
)
1545 char* basename
= strrchr(path
, '/');
1546 if (basename
== NULL
)
1549 return basename
+ 1; /* strip '/' */
1553 * The array s->used_clusters holds the states of the clusters. If it is
1554 * part of a file, it has bit 2 set, in case of a directory, bit 1. If it
1555 * was modified, bit 3 is set.
1556 * If any cluster is allocated, but not part of a file or directory, this
1557 * driver refuses to commit.
1560 USED_DIRECTORY
= 1, USED_FILE
= 2, USED_ANY
= 3, USED_ALLOCATED
= 4
1564 * get_cluster_count_for_direntry() not only determines how many clusters
1565 * are occupied by direntry, but also if it was renamed or modified.
1567 * A file is thought to be renamed *only* if there already was a file with
1568 * exactly the same first cluster, but a different name.
1570 * Further, the files/directories handled by this function are
1571 * assumed to be *not* deleted (and *only* those).
1573 static uint32_t get_cluster_count_for_direntry(BDRVVVFATState
* s
,
1574 direntry_t
* direntry
, const char* path
)
1577 * This is a little bit tricky:
1578 * IF the guest OS just inserts a cluster into the file chain,
1579 * and leaves the rest alone, (i.e. the original file had clusters
1580 * 15 -> 16, but now has 15 -> 32 -> 16), then the following happens:
1582 * - do_commit will write the cluster into the file at the given
1585 * - the cluster which is overwritten should be moved to a later
1586 * position in the file.
1588 * I am not aware that any OS does something as braindead, but this
1589 * situation could happen anyway when not committing for a long time.
1590 * Just to be sure that this does not bite us, detect it, and copy the
1591 * contents of the clusters to-be-overwritten into the qcow.
1594 int was_modified
= 0;
1597 uint32_t cluster_num
= begin_of_direntry(direntry
);
1598 uint32_t offset
= 0;
1599 int first_mapping_index
= -1;
1600 mapping_t
* mapping
= NULL
;
1601 const char* basename2
= NULL
;
1603 vvfat_close_current_file(s
);
1605 /* the root directory */
1606 if (cluster_num
== 0)
1611 basename2
= get_basename(path
);
1613 mapping
= find_mapping_for_cluster(s
, cluster_num
);
1616 const char* basename
;
1618 assert(mapping
->mode
& MODE_DELETED
);
1619 mapping
->mode
&= ~MODE_DELETED
;
1621 basename
= get_basename(mapping
->path
);
1623 assert(mapping
->mode
& MODE_NORMAL
);
1626 if (strcmp(basename
, basename2
))
1627 schedule_rename(s
, cluster_num
, g_strdup(path
));
1628 } else if (is_file(direntry
))
1630 schedule_new_file(s
, g_strdup(path
), cluster_num
);
1639 if (!copy_it
&& cluster_was_modified(s
, cluster_num
)) {
1640 if (mapping
== NULL
||
1641 mapping
->begin
> cluster_num
||
1642 mapping
->end
<= cluster_num
)
1643 mapping
= find_mapping_for_cluster(s
, cluster_num
);
1647 (mapping
->mode
& MODE_DIRECTORY
) == 0) {
1649 /* was modified in qcow */
1650 if (offset
!= mapping
->info
.file
.offset
+ s
->cluster_size
1651 * (cluster_num
- mapping
->begin
)) {
1652 /* offset of this cluster in file chain has changed */
1655 } else if (offset
== 0) {
1656 const char* basename
= get_basename(mapping
->path
);
1658 if (strcmp(basename
, basename2
))
1660 first_mapping_index
= array_index(&(s
->mapping
), mapping
);
1663 if (mapping
->first_mapping_index
!= first_mapping_index
1664 && mapping
->info
.file
.offset
> 0) {
1669 /* need to write out? */
1670 if (!was_modified
&& is_file(direntry
)) {
1672 schedule_writeout(s
, mapping
->dir_index
, offset
);
1680 * This is horribly inefficient, but that is okay, since
1681 * it is rarely executed, if at all.
1683 int64_t offset
= cluster2sector(s
, cluster_num
);
1685 vvfat_close_current_file(s
);
1686 for (i
= 0; i
< s
->sectors_per_cluster
; i
++) {
1687 if (!bdrv_is_allocated(s
->qcow
, offset
+ i
, 1, &dummy
)) {
1688 if (vvfat_read(s
->bs
, offset
, s
->cluster_buffer
, 1)) {
1691 if (bdrv_write(s
->qcow
, offset
, s
->cluster_buffer
, 1)) {
1700 if (s
->used_clusters
[cluster_num
] & USED_ANY
)
1702 s
->used_clusters
[cluster_num
] = USED_FILE
;
1704 cluster_num
= modified_fat_get(s
, cluster_num
);
1706 if (fat_eof(s
, cluster_num
))
1708 else if (cluster_num
< 2 || cluster_num
> s
->max_fat_value
- 16)
1711 offset
+= s
->cluster_size
;
1716 * This function looks at the modified data (qcow).
1717 * It returns 0 upon inconsistency or error, and the number of clusters
1718 * used by the directory, its subdirectories and their files.
1720 static int check_directory_consistency(BDRVVVFATState
*s
,
1721 int cluster_num
, const char* path
)
1724 unsigned char* cluster
= g_malloc(s
->cluster_size
);
1725 direntry_t
* direntries
= (direntry_t
*)cluster
;
1726 mapping_t
* mapping
= find_mapping_for_cluster(s
, cluster_num
);
1729 int path_len
= strlen(path
);
1730 char path2
[PATH_MAX
+ 1];
1732 assert(path_len
< PATH_MAX
); /* len was tested before! */
1733 pstrcpy(path2
, sizeof(path2
), path
);
1734 path2
[path_len
] = '/';
1735 path2
[path_len
+ 1] = '\0';
1738 const char* basename
= get_basename(mapping
->path
);
1739 const char* basename2
= get_basename(path
);
1741 assert(mapping
->mode
& MODE_DIRECTORY
);
1743 assert(mapping
->mode
& MODE_DELETED
);
1744 mapping
->mode
&= ~MODE_DELETED
;
1746 if (strcmp(basename
, basename2
))
1747 schedule_rename(s
, cluster_num
, g_strdup(path
));
1750 schedule_mkdir(s
, cluster_num
, g_strdup(path
));
1759 if (s
->used_clusters
[cluster_num
] & USED_ANY
) {
1760 fprintf(stderr
, "cluster %d used more than once\n", (int)cluster_num
);
1763 s
->used_clusters
[cluster_num
] = USED_DIRECTORY
;
1765 DLOG(fprintf(stderr
, "read cluster %d (sector %d)\n", (int)cluster_num
, (int)cluster2sector(s
, cluster_num
)));
1766 subret
= vvfat_read(s
->bs
, cluster2sector(s
, cluster_num
), cluster
,
1767 s
->sectors_per_cluster
);
1769 fprintf(stderr
, "Error fetching direntries\n");
1775 for (i
= 0; i
< 0x10 * s
->sectors_per_cluster
; i
++) {
1776 int cluster_count
= 0;
1778 DLOG(fprintf(stderr
, "check direntry %d:\n", i
); print_direntry(direntries
+ i
));
1779 if (is_volume_label(direntries
+ i
) || is_dot(direntries
+ i
) ||
1780 is_free(direntries
+ i
))
1783 subret
= parse_long_name(&lfn
, direntries
+ i
);
1785 fprintf(stderr
, "Error in long name\n");
1788 if (subret
== 0 || is_free(direntries
+ i
))
1791 if (fat_chksum(direntries
+i
) != lfn
.checksum
) {
1792 subret
= parse_short_name(s
, &lfn
, direntries
+ i
);
1794 fprintf(stderr
, "Error in short name (%d)\n", subret
);
1797 if (subret
> 0 || !strcmp((char*)lfn
.name
, ".")
1798 || !strcmp((char*)lfn
.name
, ".."))
1801 lfn
.checksum
= 0x100; /* cannot use long name twice */
1803 if (path_len
+ 1 + lfn
.len
>= PATH_MAX
) {
1804 fprintf(stderr
, "Name too long: %s/%s\n", path
, lfn
.name
);
1807 pstrcpy(path2
+ path_len
+ 1, sizeof(path2
) - path_len
- 1,
1810 if (is_directory(direntries
+ i
)) {
1811 if (begin_of_direntry(direntries
+ i
) == 0) {
1812 DLOG(fprintf(stderr
, "invalid begin for directory: %s\n", path2
); print_direntry(direntries
+ i
));
1815 cluster_count
= check_directory_consistency(s
,
1816 begin_of_direntry(direntries
+ i
), path2
);
1817 if (cluster_count
== 0) {
1818 DLOG(fprintf(stderr
, "problem in directory %s:\n", path2
); print_direntry(direntries
+ i
));
1821 } else if (is_file(direntries
+ i
)) {
1822 /* check file size with FAT */
1823 cluster_count
= get_cluster_count_for_direntry(s
, direntries
+ i
, path2
);
1824 if (cluster_count
!=
1825 (le32_to_cpu(direntries
[i
].size
) + s
->cluster_size
1826 - 1) / s
->cluster_size
) {
1827 DLOG(fprintf(stderr
, "Cluster count mismatch\n"));
1831 abort(); /* cluster_count = 0; */
1833 ret
+= cluster_count
;
1836 cluster_num
= modified_fat_get(s
, cluster_num
);
1837 } while(!fat_eof(s
, cluster_num
));
1843 /* returns 1 on success */
1844 static int is_consistent(BDRVVVFATState
* s
)
1847 int used_clusters_count
= 0;
1851 * - get modified FAT
1852 * - compare the two FATs (TODO)
1853 * - get buffer for marking used clusters
1854 * - recurse direntries from root (using bs->bdrv_read to make
1855 * sure to get the new data)
1856 * - check that the FAT agrees with the size
1857 * - count the number of clusters occupied by this directory and
1859 * - check that the cumulative used cluster count agrees with the
1861 * - if all is fine, return number of used clusters
1863 if (s
->fat2
== NULL
) {
1864 int size
= 0x200 * s
->sectors_per_fat
;
1865 s
->fat2
= g_malloc(size
);
1866 memcpy(s
->fat2
, s
->fat
.pointer
, size
);
1868 check
= vvfat_read(s
->bs
,
1869 s
->first_sectors_number
, s
->fat2
, s
->sectors_per_fat
);
1871 fprintf(stderr
, "Could not copy fat\n");
1874 assert (s
->used_clusters
);
1875 for (i
= 0; i
< sector2cluster(s
, s
->sector_count
); i
++)
1876 s
->used_clusters
[i
] &= ~USED_ANY
;
1880 /* mark every mapped file/directory as deleted.
1881 * (check_directory_consistency() will unmark those still present). */
1883 for (i
= 0; i
< s
->mapping
.next
; i
++) {
1884 mapping_t
* mapping
= array_get(&(s
->mapping
), i
);
1885 if (mapping
->first_mapping_index
< 0)
1886 mapping
->mode
|= MODE_DELETED
;
1889 used_clusters_count
= check_directory_consistency(s
, 0, s
->path
);
1890 if (used_clusters_count
<= 0) {
1891 DLOG(fprintf(stderr
, "problem in directory\n"));
1895 check
= s
->last_cluster_of_root_directory
;
1896 for (i
= check
; i
< sector2cluster(s
, s
->sector_count
); i
++) {
1897 if (modified_fat_get(s
, i
)) {
1898 if(!s
->used_clusters
[i
]) {
1899 DLOG(fprintf(stderr
, "FAT was modified (%d), but cluster is not used?\n", i
));
1905 if (s
->used_clusters
[i
] == USED_ALLOCATED
) {
1906 /* allocated, but not used... */
1907 DLOG(fprintf(stderr
, "unused, modified cluster: %d\n", i
));
1912 if (check
!= used_clusters_count
)
1915 return used_clusters_count
;
1918 static inline void adjust_mapping_indices(BDRVVVFATState
* s
,
1919 int offset
, int adjust
)
1923 for (i
= 0; i
< s
->mapping
.next
; i
++) {
1924 mapping_t
* mapping
= array_get(&(s
->mapping
), i
);
1926 #define ADJUST_MAPPING_INDEX(name) \
1927 if (mapping->name >= offset) \
1928 mapping->name += adjust
1930 ADJUST_MAPPING_INDEX(first_mapping_index
);
1931 if (mapping
->mode
& MODE_DIRECTORY
)
1932 ADJUST_MAPPING_INDEX(info
.dir
.parent_mapping_index
);
1936 /* insert or update mapping */
1937 static mapping_t
* insert_mapping(BDRVVVFATState
* s
,
1938 uint32_t begin
, uint32_t end
)
1941 * - find mapping where mapping->begin >= begin,
1942 * - if mapping->begin > begin: insert
1943 * - adjust all references to mappings!
1947 int index
= find_mapping_for_cluster_aux(s
, begin
, 0, s
->mapping
.next
);
1948 mapping_t
* mapping
= NULL
;
1949 mapping_t
* first_mapping
= array_get(&(s
->mapping
), 0);
1951 if (index
< s
->mapping
.next
&& (mapping
= array_get(&(s
->mapping
), index
))
1952 && mapping
->begin
< begin
) {
1953 mapping
->end
= begin
;
1955 mapping
= array_get(&(s
->mapping
), index
);
1957 if (index
>= s
->mapping
.next
|| mapping
->begin
> begin
) {
1958 mapping
= array_insert(&(s
->mapping
), index
, 1);
1959 mapping
->path
= NULL
;
1960 adjust_mapping_indices(s
, index
, +1);
1963 mapping
->begin
= begin
;
1966 DLOG(mapping_t
* next_mapping
;
1967 assert(index
+ 1 >= s
->mapping
.next
||
1968 ((next_mapping
= array_get(&(s
->mapping
), index
+ 1)) &&
1969 next_mapping
->begin
>= end
)));
1971 if (s
->current_mapping
&& first_mapping
!= (mapping_t
*)s
->mapping
.pointer
)
1972 s
->current_mapping
= array_get(&(s
->mapping
),
1973 s
->current_mapping
- first_mapping
);
1978 static int remove_mapping(BDRVVVFATState
* s
, int mapping_index
)
1980 mapping_t
* mapping
= array_get(&(s
->mapping
), mapping_index
);
1981 mapping_t
* first_mapping
= array_get(&(s
->mapping
), 0);
1984 if (mapping
->first_mapping_index
< 0) {
1985 g_free(mapping
->path
);
1988 /* remove from s->mapping */
1989 array_remove(&(s
->mapping
), mapping_index
);
1991 /* adjust all references to mappings */
1992 adjust_mapping_indices(s
, mapping_index
, -1);
1994 if (s
->current_mapping
&& first_mapping
!= (mapping_t
*)s
->mapping
.pointer
)
1995 s
->current_mapping
= array_get(&(s
->mapping
),
1996 s
->current_mapping
- first_mapping
);
2001 static void adjust_dirindices(BDRVVVFATState
* s
, int offset
, int adjust
)
2004 for (i
= 0; i
< s
->mapping
.next
; i
++) {
2005 mapping_t
* mapping
= array_get(&(s
->mapping
), i
);
2006 if (mapping
->dir_index
>= offset
)
2007 mapping
->dir_index
+= adjust
;
2008 if ((mapping
->mode
& MODE_DIRECTORY
) &&
2009 mapping
->info
.dir
.first_dir_index
>= offset
)
2010 mapping
->info
.dir
.first_dir_index
+= adjust
;
2014 static direntry_t
* insert_direntries(BDRVVVFATState
* s
,
2015 int dir_index
, int count
)
2018 * make room in s->directory,
2021 direntry_t
* result
= array_insert(&(s
->directory
), dir_index
, count
);
2024 adjust_dirindices(s
, dir_index
, count
);
2028 static int remove_direntries(BDRVVVFATState
* s
, int dir_index
, int count
)
2030 int ret
= array_remove_slice(&(s
->directory
), dir_index
, count
);
2033 adjust_dirindices(s
, dir_index
, -count
);
2038 * Adapt the mappings of the cluster chain starting at first cluster
2039 * (i.e. if a file starts at first_cluster, the chain is followed according
2040 * to the modified fat, and the corresponding entries in s->mapping are
2043 static int commit_mappings(BDRVVVFATState
* s
,
2044 uint32_t first_cluster
, int dir_index
)
2046 mapping_t
* mapping
= find_mapping_for_cluster(s
, first_cluster
);
2047 direntry_t
* direntry
= array_get(&(s
->directory
), dir_index
);
2048 uint32_t cluster
= first_cluster
;
2050 vvfat_close_current_file(s
);
2053 assert(mapping
->begin
== first_cluster
);
2054 mapping
->first_mapping_index
= -1;
2055 mapping
->dir_index
= dir_index
;
2056 mapping
->mode
= (dir_index
<= 0 || is_directory(direntry
)) ?
2057 MODE_DIRECTORY
: MODE_NORMAL
;
2059 while (!fat_eof(s
, cluster
)) {
2062 for (c
= cluster
, c1
= modified_fat_get(s
, c
); c
+ 1 == c1
;
2063 c
= c1
, c1
= modified_fat_get(s
, c1
));
2066 if (c
> mapping
->end
) {
2067 int index
= array_index(&(s
->mapping
), mapping
);
2068 int i
, max_i
= s
->mapping
.next
- index
;
2069 for (i
= 1; i
< max_i
&& mapping
[i
].begin
< c
; i
++);
2071 remove_mapping(s
, index
+ 1);
2073 assert(mapping
== array_get(&(s
->mapping
), s
->mapping
.next
- 1)
2074 || mapping
[1].begin
>= c
);
2077 if (!fat_eof(s
, c1
)) {
2078 int i
= find_mapping_for_cluster_aux(s
, c1
, 0, s
->mapping
.next
);
2079 mapping_t
* next_mapping
= i
>= s
->mapping
.next
? NULL
:
2080 array_get(&(s
->mapping
), i
);
2082 if (next_mapping
== NULL
|| next_mapping
->begin
> c1
) {
2083 int i1
= array_index(&(s
->mapping
), mapping
);
2085 next_mapping
= insert_mapping(s
, c1
, c1
+1);
2089 mapping
= array_get(&(s
->mapping
), i1
);
2092 next_mapping
->dir_index
= mapping
->dir_index
;
2093 next_mapping
->first_mapping_index
=
2094 mapping
->first_mapping_index
< 0 ?
2095 array_index(&(s
->mapping
), mapping
) :
2096 mapping
->first_mapping_index
;
2097 next_mapping
->path
= mapping
->path
;
2098 next_mapping
->mode
= mapping
->mode
;
2099 next_mapping
->read_only
= mapping
->read_only
;
2100 if (mapping
->mode
& MODE_DIRECTORY
) {
2101 next_mapping
->info
.dir
.parent_mapping_index
=
2102 mapping
->info
.dir
.parent_mapping_index
;
2103 next_mapping
->info
.dir
.first_dir_index
=
2104 mapping
->info
.dir
.first_dir_index
+
2105 0x10 * s
->sectors_per_cluster
*
2106 (mapping
->end
- mapping
->begin
);
2108 next_mapping
->info
.file
.offset
= mapping
->info
.file
.offset
+
2109 mapping
->end
- mapping
->begin
;
2111 mapping
= next_mapping
;
2120 static int commit_direntries(BDRVVVFATState
* s
,
2121 int dir_index
, int parent_mapping_index
)
2123 direntry_t
* direntry
= array_get(&(s
->directory
), dir_index
);
2124 uint32_t first_cluster
= dir_index
== 0 ? 0 : begin_of_direntry(direntry
);
2125 mapping_t
* mapping
= find_mapping_for_cluster(s
, first_cluster
);
2127 int factor
= 0x10 * s
->sectors_per_cluster
;
2128 int old_cluster_count
, new_cluster_count
;
2129 int current_dir_index
= mapping
->info
.dir
.first_dir_index
;
2130 int first_dir_index
= current_dir_index
;
2134 DLOG(fprintf(stderr
, "commit_direntries for %s, parent_mapping_index %d\n", mapping
->path
, parent_mapping_index
));
2138 assert(mapping
->begin
== first_cluster
);
2139 assert(mapping
->info
.dir
.first_dir_index
< s
->directory
.next
);
2140 assert(mapping
->mode
& MODE_DIRECTORY
);
2141 assert(dir_index
== 0 || is_directory(direntry
));
2143 mapping
->info
.dir
.parent_mapping_index
= parent_mapping_index
;
2145 if (first_cluster
== 0) {
2146 old_cluster_count
= new_cluster_count
=
2147 s
->last_cluster_of_root_directory
;
2149 for (old_cluster_count
= 0, c
= first_cluster
; !fat_eof(s
, c
);
2151 old_cluster_count
++;
2153 for (new_cluster_count
= 0, c
= first_cluster
; !fat_eof(s
, c
);
2154 c
= modified_fat_get(s
, c
))
2155 new_cluster_count
++;
2158 if (new_cluster_count
> old_cluster_count
) {
2159 if (insert_direntries(s
,
2160 current_dir_index
+ factor
* old_cluster_count
,
2161 factor
* (new_cluster_count
- old_cluster_count
)) == NULL
)
2163 } else if (new_cluster_count
< old_cluster_count
)
2164 remove_direntries(s
,
2165 current_dir_index
+ factor
* new_cluster_count
,
2166 factor
* (old_cluster_count
- new_cluster_count
));
2168 for (c
= first_cluster
; !fat_eof(s
, c
); c
= modified_fat_get(s
, c
)) {
2169 void* direntry
= array_get(&(s
->directory
), current_dir_index
);
2170 int ret
= vvfat_read(s
->bs
, cluster2sector(s
, c
), direntry
,
2171 s
->sectors_per_cluster
);
2174 assert(!strncmp(s
->directory
.pointer
, "QEMU", 4));
2175 current_dir_index
+= factor
;
2178 ret
= commit_mappings(s
, first_cluster
, dir_index
);
2183 for (i
= 0; i
< factor
* new_cluster_count
; i
++) {
2184 direntry
= array_get(&(s
->directory
), first_dir_index
+ i
);
2185 if (is_directory(direntry
) && !is_dot(direntry
)) {
2186 mapping
= find_mapping_for_cluster(s
, first_cluster
);
2187 assert(mapping
->mode
& MODE_DIRECTORY
);
2188 ret
= commit_direntries(s
, first_dir_index
+ i
,
2189 array_index(&(s
->mapping
), mapping
));
2198 /* commit one file (adjust contents, adjust mapping),
2199 return first_mapping_index */
2200 static int commit_one_file(BDRVVVFATState
* s
,
2201 int dir_index
, uint32_t offset
)
2203 direntry_t
* direntry
= array_get(&(s
->directory
), dir_index
);
2204 uint32_t c
= begin_of_direntry(direntry
);
2205 uint32_t first_cluster
= c
;
2206 mapping_t
* mapping
= find_mapping_for_cluster(s
, c
);
2207 uint32_t size
= filesize_of_direntry(direntry
);
2208 char* cluster
= g_malloc(s
->cluster_size
);
2212 assert(offset
< size
);
2213 assert((offset
% s
->cluster_size
) == 0);
2215 for (i
= s
->cluster_size
; i
< offset
; i
+= s
->cluster_size
)
2216 c
= modified_fat_get(s
, c
);
2218 fd
= open(mapping
->path
, O_RDWR
| O_CREAT
| O_BINARY
, 0666);
2220 fprintf(stderr
, "Could not open %s... (%s, %d)\n", mapping
->path
,
2221 strerror(errno
), errno
);
2226 if (lseek(fd
, offset
, SEEK_SET
) != offset
) {
2233 while (offset
< size
) {
2235 int rest_size
= (size
- offset
> s
->cluster_size
?
2236 s
->cluster_size
: size
- offset
);
2239 c1
= modified_fat_get(s
, c
);
2241 assert((size
- offset
== 0 && fat_eof(s
, c
)) ||
2242 (size
> offset
&& c
>=2 && !fat_eof(s
, c
)));
2244 ret
= vvfat_read(s
->bs
, cluster2sector(s
, c
),
2245 (uint8_t*)cluster
, (rest_size
+ 0x1ff) / 0x200);
2253 if (write(fd
, cluster
, rest_size
) < 0) {
2259 offset
+= rest_size
;
2263 if (ftruncate(fd
, size
)) {
2264 perror("ftruncate()");
2272 return commit_mappings(s
, first_cluster
, dir_index
);
2276 /* test, if all mappings point to valid direntries */
2277 static void check1(BDRVVVFATState
* s
)
2280 for (i
= 0; i
< s
->mapping
.next
; i
++) {
2281 mapping_t
* mapping
= array_get(&(s
->mapping
), i
);
2282 if (mapping
->mode
& MODE_DELETED
) {
2283 fprintf(stderr
, "deleted\n");
2286 assert(mapping
->dir_index
< s
->directory
.next
);
2287 direntry_t
* direntry
= array_get(&(s
->directory
), mapping
->dir_index
);
2288 assert(mapping
->begin
== begin_of_direntry(direntry
) || mapping
->first_mapping_index
>= 0);
2289 if (mapping
->mode
& MODE_DIRECTORY
) {
2290 assert(mapping
->info
.dir
.first_dir_index
+ 0x10 * s
->sectors_per_cluster
* (mapping
->end
- mapping
->begin
) <= s
->directory
.next
);
2291 assert((mapping
->info
.dir
.first_dir_index
% (0x10 * s
->sectors_per_cluster
)) == 0);
2296 /* test, if all direntries have mappings */
2297 static void check2(BDRVVVFATState
* s
)
2300 int first_mapping
= -1;
2302 for (i
= 0; i
< s
->directory
.next
; i
++) {
2303 direntry_t
* direntry
= array_get(&(s
->directory
), i
);
2305 if (is_short_name(direntry
) && begin_of_direntry(direntry
)) {
2306 mapping_t
* mapping
= find_mapping_for_cluster(s
, begin_of_direntry(direntry
));
2308 assert(mapping
->dir_index
== i
|| is_dot(direntry
));
2309 assert(mapping
->begin
== begin_of_direntry(direntry
) || is_dot(direntry
));
2312 if ((i
% (0x10 * s
->sectors_per_cluster
)) == 0) {
2316 for (j
= 0; j
< s
->mapping
.next
; j
++) {
2317 mapping_t
* mapping
= array_get(&(s
->mapping
), j
);
2318 if (mapping
->mode
& MODE_DELETED
)
2320 if (mapping
->mode
& MODE_DIRECTORY
) {
2321 if (mapping
->info
.dir
.first_dir_index
<= i
&& mapping
->info
.dir
.first_dir_index
+ 0x10 * s
->sectors_per_cluster
> i
) {
2322 assert(++count
== 1);
2323 if (mapping
->first_mapping_index
== -1)
2324 first_mapping
= array_index(&(s
->mapping
), mapping
);
2326 assert(first_mapping
== mapping
->first_mapping_index
);
2327 if (mapping
->info
.dir
.parent_mapping_index
< 0)
2330 mapping_t
* parent
= array_get(&(s
->mapping
), mapping
->info
.dir
.parent_mapping_index
);
2331 assert(parent
->mode
& MODE_DIRECTORY
);
2332 assert(parent
->info
.dir
.first_dir_index
< mapping
->info
.dir
.first_dir_index
);
2344 static int handle_renames_and_mkdirs(BDRVVVFATState
* s
)
2349 fprintf(stderr
, "handle_renames\n");
2350 for (i
= 0; i
< s
->commits
.next
; i
++) {
2351 commit_t
* commit
= array_get(&(s
->commits
), i
);
2352 fprintf(stderr
, "%d, %s (%d, %d)\n", i
, commit
->path
? commit
->path
: "(null)", commit
->param
.rename
.cluster
, commit
->action
);
2356 for (i
= 0; i
< s
->commits
.next
;) {
2357 commit_t
* commit
= array_get(&(s
->commits
), i
);
2358 if (commit
->action
== ACTION_RENAME
) {
2359 mapping_t
* mapping
= find_mapping_for_cluster(s
,
2360 commit
->param
.rename
.cluster
);
2361 char* old_path
= mapping
->path
;
2363 assert(commit
->path
);
2364 mapping
->path
= commit
->path
;
2365 if (rename(old_path
, mapping
->path
))
2368 if (mapping
->mode
& MODE_DIRECTORY
) {
2369 int l1
= strlen(mapping
->path
);
2370 int l2
= strlen(old_path
);
2372 direntry_t
* direntry
= array_get(&(s
->directory
),
2373 mapping
->info
.dir
.first_dir_index
);
2374 uint32_t c
= mapping
->begin
;
2378 while (!fat_eof(s
, c
)) {
2380 direntry_t
* d
= direntry
+ i
;
2382 if (is_file(d
) || (is_directory(d
) && !is_dot(d
))) {
2383 mapping_t
* m
= find_mapping_for_cluster(s
,
2384 begin_of_direntry(d
));
2385 int l
= strlen(m
->path
);
2386 char* new_path
= g_malloc(l
+ diff
+ 1);
2388 assert(!strncmp(m
->path
, mapping
->path
, l2
));
2390 pstrcpy(new_path
, l
+ diff
+ 1, mapping
->path
);
2391 pstrcpy(new_path
+ l1
, l
+ diff
+ 1 - l1
,
2394 schedule_rename(s
, m
->begin
, new_path
);
2397 } while((i
% (0x10 * s
->sectors_per_cluster
)) != 0);
2403 array_remove(&(s
->commits
), i
);
2405 } else if (commit
->action
== ACTION_MKDIR
) {
2407 int j
, parent_path_len
;
2410 if (mkdir(commit
->path
))
2413 if (mkdir(commit
->path
, 0755))
2417 mapping
= insert_mapping(s
, commit
->param
.mkdir
.cluster
,
2418 commit
->param
.mkdir
.cluster
+ 1);
2419 if (mapping
== NULL
)
2422 mapping
->mode
= MODE_DIRECTORY
;
2423 mapping
->read_only
= 0;
2424 mapping
->path
= commit
->path
;
2425 j
= s
->directory
.next
;
2427 insert_direntries(s
, s
->directory
.next
,
2428 0x10 * s
->sectors_per_cluster
);
2429 mapping
->info
.dir
.first_dir_index
= j
;
2431 parent_path_len
= strlen(commit
->path
)
2432 - strlen(get_basename(commit
->path
)) - 1;
2433 for (j
= 0; j
< s
->mapping
.next
; j
++) {
2434 mapping_t
* m
= array_get(&(s
->mapping
), j
);
2435 if (m
->first_mapping_index
< 0 && m
!= mapping
&&
2436 !strncmp(m
->path
, mapping
->path
, parent_path_len
) &&
2437 strlen(m
->path
) == parent_path_len
)
2440 assert(j
< s
->mapping
.next
);
2441 mapping
->info
.dir
.parent_mapping_index
= j
;
2443 array_remove(&(s
->commits
), i
);
2453 * TODO: make sure that the short name is not matching *another* file
2455 static int handle_commits(BDRVVVFATState
* s
)
2459 vvfat_close_current_file(s
);
2461 for (i
= 0; !fail
&& i
< s
->commits
.next
; i
++) {
2462 commit_t
* commit
= array_get(&(s
->commits
), i
);
2463 switch(commit
->action
) {
2464 case ACTION_RENAME
: case ACTION_MKDIR
:
2468 case ACTION_WRITEOUT
: {
2470 /* these variables are only used by assert() below */
2471 direntry_t
* entry
= array_get(&(s
->directory
),
2472 commit
->param
.writeout
.dir_index
);
2473 uint32_t begin
= begin_of_direntry(entry
);
2474 mapping_t
* mapping
= find_mapping_for_cluster(s
, begin
);
2478 assert(mapping
->begin
== begin
);
2479 assert(commit
->path
== NULL
);
2481 if (commit_one_file(s
, commit
->param
.writeout
.dir_index
,
2482 commit
->param
.writeout
.modified_offset
))
2487 case ACTION_NEW_FILE
: {
2488 int begin
= commit
->param
.new_file
.first_cluster
;
2489 mapping_t
* mapping
= find_mapping_for_cluster(s
, begin
);
2494 for (i
= 0; i
< s
->directory
.next
; i
++) {
2495 entry
= array_get(&(s
->directory
), i
);
2496 if (is_file(entry
) && begin_of_direntry(entry
) == begin
)
2500 if (i
>= s
->directory
.next
) {
2505 /* make sure there exists an initial mapping */
2506 if (mapping
&& mapping
->begin
!= begin
) {
2507 mapping
->end
= begin
;
2510 if (mapping
== NULL
) {
2511 mapping
= insert_mapping(s
, begin
, begin
+1);
2513 /* most members will be fixed in commit_mappings() */
2514 assert(commit
->path
);
2515 mapping
->path
= commit
->path
;
2516 mapping
->read_only
= 0;
2517 mapping
->mode
= MODE_NORMAL
;
2518 mapping
->info
.file
.offset
= 0;
2520 if (commit_one_file(s
, i
, 0))
2529 if (i
> 0 && array_remove_slice(&(s
->commits
), 0, i
))
2534 static int handle_deletes(BDRVVVFATState
* s
)
2536 int i
, deferred
= 1, deleted
= 1;
2538 /* delete files corresponding to mappings marked as deleted */
2539 /* handle DELETEs and unused mappings (modified_fat_get(s, mapping->begin) == 0) */
2540 while (deferred
&& deleted
) {
2544 for (i
= 1; i
< s
->mapping
.next
; i
++) {
2545 mapping_t
* mapping
= array_get(&(s
->mapping
), i
);
2546 if (mapping
->mode
& MODE_DELETED
) {
2547 direntry_t
* entry
= array_get(&(s
->directory
),
2548 mapping
->dir_index
);
2550 if (is_free(entry
)) {
2551 /* remove file/directory */
2552 if (mapping
->mode
& MODE_DIRECTORY
) {
2553 int j
, next_dir_index
= s
->directory
.next
,
2554 first_dir_index
= mapping
->info
.dir
.first_dir_index
;
2556 if (rmdir(mapping
->path
) < 0) {
2557 if (errno
== ENOTEMPTY
) {
2564 for (j
= 1; j
< s
->mapping
.next
; j
++) {
2565 mapping_t
* m
= array_get(&(s
->mapping
), j
);
2566 if (m
->mode
& MODE_DIRECTORY
&&
2567 m
->info
.dir
.first_dir_index
>
2569 m
->info
.dir
.first_dir_index
<
2572 m
->info
.dir
.first_dir_index
;
2574 remove_direntries(s
, first_dir_index
,
2575 next_dir_index
- first_dir_index
);
2580 if (unlink(mapping
->path
))
2584 DLOG(fprintf(stderr
, "DELETE (%d)\n", i
); print_mapping(mapping
); print_direntry(entry
));
2585 remove_mapping(s
, i
);
2594 * synchronize mapping with new state:
2596 * - copy FAT (with bdrv_read)
2597 * - mark all filenames corresponding to mappings as deleted
2598 * - recurse direntries from root (using bs->bdrv_read)
2599 * - delete files corresponding to mappings marked as deleted
2601 static int do_commit(BDRVVVFATState
* s
)
2605 /* the real meat are the commits. Nothing to do? Move along! */
2606 if (s
->commits
.next
== 0)
2609 vvfat_close_current_file(s
);
2611 ret
= handle_renames_and_mkdirs(s
);
2613 fprintf(stderr
, "Error handling renames (%d)\n", ret
);
2618 /* copy FAT (with bdrv_read) */
2619 memcpy(s
->fat
.pointer
, s
->fat2
, 0x200 * s
->sectors_per_fat
);
2621 /* recurse direntries from root (using bs->bdrv_read) */
2622 ret
= commit_direntries(s
, 0, -1);
2624 fprintf(stderr
, "Fatal: error while committing (%d)\n", ret
);
2629 ret
= handle_commits(s
);
2631 fprintf(stderr
, "Error handling commits (%d)\n", ret
);
2636 ret
= handle_deletes(s
);
2638 fprintf(stderr
, "Error deleting\n");
2643 if (s
->qcow
->drv
->bdrv_make_empty
) {
2644 s
->qcow
->drv
->bdrv_make_empty(s
->qcow
);
2647 memset(s
->used_clusters
, 0, sector2cluster(s
, s
->sector_count
));
2653 static int try_commit(BDRVVVFATState
* s
)
2655 vvfat_close_current_file(s
);
2657 if(!is_consistent(s
))
2659 return do_commit(s
);
2662 static int vvfat_write(BlockDriverState
*bs
, int64_t sector_num
,
2663 const uint8_t *buf
, int nb_sectors
)
2665 BDRVVVFATState
*s
= bs
->opaque
;
2670 /* Check if we're operating in read-only mode */
2671 if (s
->qcow
== NULL
) {
2675 vvfat_close_current_file(s
);
2678 * Some sanity checks:
2679 * - do not allow writing to the boot sector
2680 * - do not allow to write non-ASCII filenames
2683 if (sector_num
< s
->first_sectors_number
)
2686 for (i
= sector2cluster(s
, sector_num
);
2687 i
<= sector2cluster(s
, sector_num
+ nb_sectors
- 1);) {
2688 mapping_t
* mapping
= find_mapping_for_cluster(s
, i
);
2690 if (mapping
->read_only
) {
2691 fprintf(stderr
, "Tried to write to write-protected file %s\n",
2696 if (mapping
->mode
& MODE_DIRECTORY
) {
2697 int begin
= cluster2sector(s
, i
);
2698 int end
= begin
+ s
->sectors_per_cluster
, k
;
2700 const direntry_t
* direntries
;
2705 if (begin
< sector_num
)
2707 if (end
> sector_num
+ nb_sectors
)
2708 end
= sector_num
+ nb_sectors
;
2709 dir_index
= mapping
->dir_index
+
2710 0x10 * (begin
- mapping
->begin
* s
->sectors_per_cluster
);
2711 direntries
= (direntry_t
*)(buf
+ 0x200 * (begin
- sector_num
));
2713 for (k
= 0; k
< (end
- begin
) * 0x10; k
++) {
2714 /* do not allow non-ASCII filenames */
2715 if (parse_long_name(&lfn
, direntries
+ k
) < 0) {
2716 fprintf(stderr
, "Warning: non-ASCII filename\n");
2719 /* no access to the direntry of a read-only file */
2720 else if (is_short_name(direntries
+k
) &&
2721 (direntries
[k
].attributes
& 1)) {
2722 if (memcmp(direntries
+ k
,
2723 array_get(&(s
->directory
), dir_index
+ k
),
2724 sizeof(direntry_t
))) {
2725 fprintf(stderr
, "Warning: tried to write to write-protected file\n");
2737 * Use qcow backend. Commit later.
2739 DLOG(fprintf(stderr
, "Write to qcow backend: %d + %d\n", (int)sector_num
, nb_sectors
));
2740 ret
= bdrv_write(s
->qcow
, sector_num
, buf
, nb_sectors
);
2742 fprintf(stderr
, "Error writing to qcow backend\n");
2746 for (i
= sector2cluster(s
, sector_num
);
2747 i
<= sector2cluster(s
, sector_num
+ nb_sectors
- 1); i
++)
2749 s
->used_clusters
[i
] |= USED_ALLOCATED
;
2752 /* TODO: add timeout */
2759 static coroutine_fn
int vvfat_co_write(BlockDriverState
*bs
, int64_t sector_num
,
2760 const uint8_t *buf
, int nb_sectors
)
2763 BDRVVVFATState
*s
= bs
->opaque
;
2764 qemu_co_mutex_lock(&s
->lock
);
2765 ret
= vvfat_write(bs
, sector_num
, buf
, nb_sectors
);
2766 qemu_co_mutex_unlock(&s
->lock
);
2770 static int coroutine_fn
vvfat_co_is_allocated(BlockDriverState
*bs
,
2771 int64_t sector_num
, int nb_sectors
, int* n
)
2773 BDRVVVFATState
* s
= bs
->opaque
;
2774 *n
= s
->sector_count
- sector_num
;
2775 if (*n
> nb_sectors
)
2782 static int write_target_commit(BlockDriverState
*bs
, int64_t sector_num
,
2783 const uint8_t* buffer
, int nb_sectors
) {
2784 BDRVVVFATState
* s
= *((BDRVVVFATState
**) bs
->opaque
);
2785 return try_commit(s
);
2788 static void write_target_close(BlockDriverState
*bs
) {
2789 BDRVVVFATState
* s
= *((BDRVVVFATState
**) bs
->opaque
);
2790 bdrv_delete(s
->qcow
);
2791 g_free(s
->qcow_filename
);
2794 static BlockDriver vvfat_write_target
= {
2795 .format_name
= "vvfat_write_target",
2796 .bdrv_write
= write_target_commit
,
2797 .bdrv_close
= write_target_close
,
2800 static int enable_write_target(BDRVVVFATState
*s
)
2802 BlockDriver
*bdrv_qcow
;
2803 QEMUOptionParameter
*options
;
2805 int size
= sector2cluster(s
, s
->sector_count
);
2806 s
->used_clusters
= calloc(size
, 1);
2808 array_init(&(s
->commits
), sizeof(commit_t
));
2810 s
->qcow_filename
= g_malloc(1024);
2811 ret
= get_tmp_filename(s
->qcow_filename
, 1024);
2813 g_free(s
->qcow_filename
);
2814 s
->qcow_filename
= NULL
;
2818 bdrv_qcow
= bdrv_find_format("qcow");
2819 options
= parse_option_parameters("", bdrv_qcow
->create_options
, NULL
);
2820 set_option_parameter_int(options
, BLOCK_OPT_SIZE
, s
->sector_count
* 512);
2821 set_option_parameter(options
, BLOCK_OPT_BACKING_FILE
, "fat:");
2823 if (bdrv_create(bdrv_qcow
, s
->qcow_filename
, options
) < 0)
2826 s
->qcow
= bdrv_new("");
2827 if (s
->qcow
== NULL
) {
2831 ret
= bdrv_open(s
->qcow
, s
->qcow_filename
,
2832 BDRV_O_RDWR
| BDRV_O_CACHE_WB
| BDRV_O_NO_FLUSH
, bdrv_qcow
);
2838 unlink(s
->qcow_filename
);
2841 s
->bs
->backing_hd
= calloc(sizeof(BlockDriverState
), 1);
2842 s
->bs
->backing_hd
->drv
= &vvfat_write_target
;
2843 s
->bs
->backing_hd
->opaque
= g_malloc(sizeof(void*));
2844 *(void**)s
->bs
->backing_hd
->opaque
= s
;
2849 static void vvfat_close(BlockDriverState
*bs
)
2851 BDRVVVFATState
*s
= bs
->opaque
;
2853 vvfat_close_current_file(s
);
2854 array_free(&(s
->fat
));
2855 array_free(&(s
->directory
));
2856 array_free(&(s
->mapping
));
2857 g_free(s
->cluster_buffer
);
2860 migrate_del_blocker(s
->migration_blocker
);
2861 error_free(s
->migration_blocker
);
2865 static BlockDriver bdrv_vvfat
= {
2866 .format_name
= "vvfat",
2867 .instance_size
= sizeof(BDRVVVFATState
),
2868 .bdrv_file_open
= vvfat_open
,
2869 .bdrv_rebind
= vvfat_rebind
,
2870 .bdrv_read
= vvfat_co_read
,
2871 .bdrv_write
= vvfat_co_write
,
2872 .bdrv_close
= vvfat_close
,
2873 .bdrv_co_is_allocated
= vvfat_co_is_allocated
,
2874 .protocol_name
= "fat",
2877 static void bdrv_vvfat_init(void)
2879 bdrv_register(&bdrv_vvfat
);
2882 block_init(bdrv_vvfat_init
);
2885 static void checkpoint(void) {
2886 assert(((mapping_t
*)array_get(&(vvv
->mapping
), 0))->end
== 2);
2889 assert(!vvv
->current_mapping
|| vvv
->current_fd
|| (vvv
->current_mapping
->mode
& MODE_DIRECTORY
));
2891 if (((direntry_t
*)vvv
->directory
.pointer
)[1].attributes
!= 0xf)
2892 fprintf(stderr
, "Nonono!\n");
2894 direntry_t
* direntry
;
2895 assert(vvv
->mapping
.size
>= vvv
->mapping
.item_size
* vvv
->mapping
.next
);
2896 assert(vvv
->directory
.size
>= vvv
->directory
.item_size
* vvv
->directory
.next
);
2897 if (vvv
->mapping
.next
<47)
2899 assert((mapping
= array_get(&(vvv
->mapping
), 47)));
2900 assert(mapping
->dir_index
< vvv
->directory
.next
);
2901 direntry
= array_get(&(vvv
->directory
), mapping
->dir_index
);
2902 assert(!memcmp(direntry
->name
, "USB H ", 11) || direntry
->name
[0]==0);