source: soft/giet_vm/giet_fat32/fat32.c @ 619

Last change on this file since 619 was 619, checked in by guerin, 9 years ago

fat32: use strcmp instead of strncmp

The length argument was wrong most of the time. Avoid confusion by
not specifying it.

  • Property svn:executable set to *
File size: 159.3 KB
Line 
1//////////////////////////////////////////////////////////////////////////////////
2// Date     : 01/06/2015
3// Authors  : Alain Greiner
4// Copyright (c) UPMC-LIP6
5//////////////////////////////////////////////////////////////////////////////////
6// The fat32.h and fat32.c files define a library of access functions
7// to a FAT32 disk on a block device. It is intended to be used by both
8// the boot code and the kernel code.
9//////////////////////////////////////////////////////////////////////////////////
10// Implementation notes:
11// 1. the "lba" (Logical Block Address) is the physical sector index on
12//    the block device. The physical sector size is supposed to be 512 bytes.
13// 2. the "cluster" variable is actually a cluster index. A cluster contains
14//    8 sectors (4K bytes) and the cluster index is a 32 bits word.
15// 3. Each file or directory referenced by the software is represented
16//    by an "inode". The set of "inodes" is organised as a tree, that is
17//    a sub-tree of the complete file system existing on the block device.
18// 4. A given file can be referenced by several software tasks, and each task
19//    will use a private handler, called a "file descriptor", allocated by the OS
20//    when the task open the file, that is organised as an indexed array.
21// 5. This FAT32 library implements (N+1) caches : one private "File_ Cache"
22//    for each referenced file or directory, and a specific "Fat_Cache" for
23//    the FAT itself. Each cache contain a variable number of clusters that are
24//    dynamically allocated when they are accessed, and organised as a 64-Tree.
25//////////////////////////////////////////////////////////////////////////////////
26// General Debug Policy:
27// The global variable GIET_DEBUG_FAT is defined in the giet_config.h file.
28// The debug is activated if (proctime > GIET_DEBUG_FAT) && (GIET_DEBUG_FAT != 0)
29// The GIET_DEBUG_FAT bit 0 defines the level of debug:
30//    if   (GIET_DEBUG_FAT & 0x1)    => detailed debug
31//    else                           => external functions only
32//////////////////////////////////////////////////////////////////////////////////
33
34#include <giet_config.h>
35#include <hard_config.h>
36#include <fat32.h>
37#include <utils.h>
38#include <vmem.h>
39#include <kernel_malloc.h>
40#include <bdv_driver.h>
41#include <hba_driver.h>
42#include <sdc_driver.h>
43#include <rdk_driver.h>
44#include <mmc_driver.h>
45#include <tty0.h>
46
47//////////////////////////////////////////////////////////////////////////////////
48//               Global variables
49//////////////////////////////////////////////////////////////////////////////////
50
51// Fat-Descriptor
52__attribute__((section(".kdata")))
53fat_desc_t _fat __attribute__((aligned(64))); 
54
55// buffer used by boot code as a simple cache when scanning FAT
56__attribute__((section(".kdata")))
57unsigned char  _fat_buffer_fat[4096] __attribute__((aligned(64)));
58
59// buffer used by boot code as a simple cache when scanning a directory in DATA region
60__attribute__((section(".kdata")))
61unsigned char  _fat_buffer_data[4096] __attribute__((aligned(64)));
62
63// lba of cluster in fat_buffer_fat
64__attribute__((section(".kdata")))
65unsigned int   _fat_buffer_fat_lba;
66
67// lba of cluster in fat_buffer_data
68__attribute__((section(".kdata")))
69unsigned int   _fat_buffer_data_lba;
70
71//////////////////////////////////////////////////////////////////////////////////
72//////////////////////////////////////////////////////////////////////////////////
73//                  Static functions declaration
74//////////////////////////////////////////////////////////////////////////////////
75//////////////////////////////////////////////////////////////////////////////////
76
77
78///////////////////////////////////////////////////////////////////////////////////
79// This debug function displays the content of a 512 bytes buffer "buf",
80// with an identifier defined by the "string" and "block_id" arguments.
81///////////////////////////////////////////////////////////////////////////////////
82
83#if GIET_DEBUG_FAT
84static void _display_one_block( unsigned char* buf,
85                                char*          string,
86                                unsigned int   block_id );
87#endif
88
89//////////////////////////////////////////////////////////////////////////////////
90// This debug function displays the FAT descriptor.
91//////////////////////////////////////////////////////////////////////////////////
92
93#if GIET_DEBUG_FAT
94static void _display_fat_descriptor();
95#endif
96
97/////////////////////////////////////////////////////////////////////////////////
98// This debug function displays the sequence of clusters allocated to a
99// file (or directory) identified by the "inode" argument.
100/////////////////////////////////////////////////////////////////////////////////
101
102#if GIET_DEBUG_FAT
103static void _display_clusters_list( fat_inode_t* inode );
104#endif
105
106/////////////////////////////////////////////////////////////////////////////////
107// The following function transfers one or several blocks between the device
108// and a memory buffer identified by a virtual address.
109// It computes the memory buffer physical address, and calls the proper
110// IOC driver depending on the subtype (BDV / HBA / SDC / SPI / RDK).
111// The use_irq argument allows to activate the descheduling mode,
112// if it supported by the IOC driver subtype
113// It returns O  in case of success.
114// It returns -1 in case of error.
115/////////////////////////////////////////////////////////////////////////////////
116
117static int _fat_ioc_access( unsigned int use_irq,
118                            unsigned int to_mem,
119                            unsigned int lba,
120                            unsigned int buf_vaddr,
121                            unsigned int count );
122
123//////////////////////////////////////////////////////////////////////////////////
124// The following function returns in the "desc" argument a pointer on a buffer
125// descriptor contained in a File_Cache, or in the Fat_Cache.
126// The searched buffer is idenfified by the "inode" and "cluster_id" arguments.
127// If the "inode" pointer is not NULL, the searched cache is a File-Cache.
128// If the "inode" pointer is NULL, the searched cache is the Fat-Cache,
129// The "cluster_id" argument is the buffer index in the file (or in the FAT).
130// In case of miss, it allocate a 4 Kbytes buffer and a cluster descriptor
131// from the local kernel heap, and calls the _fat_ioc_access() function to load
132// the missing cluster from the block device.
133// It returns O  in case of success.
134// It returns 1 in case of error.
135//////////////////////////////////////////////////////////////////////////////////
136
137static unsigned int _get_buffer_from_cache( fat_inode_t*        inode,
138                                            unsigned int        cluster_id,
139                                            fat_cache_desc_t**  desc );
140
141////////////////////////////////////////////////////////////////////////////////
142// This function extract a (partial) name from a LFN directory entry.
143////////////////////////////////////////////////////////////////////////////////
144
145static void _get_name_from_long( unsigned char* buffer, 
146                                 char*          name );
147
148////////////////////////////////////////////////////////////////////////////////
149// The following function extract a name from a NORMAL directory entry.
150////////////////////////////////////////////////////////////////////////////////
151
152static void _get_name_from_short( unsigned char* buffer,
153                                  char*          name );
154
155//////////////////////////////////////////////////////////////////////////////////
156// This function returns the number of levels of a File-Cache (or Fat-Cache)
157// from the size of the file (or FAT).
158//////////////////////////////////////////////////////////////////////////////////
159
160static inline unsigned int _get_levels_from_size( unsigned int size );
161
162///////////////////////////////////////////////////////////////////////////////////
163// The following function analyses the "pathname" argument, from the character
164// defined by the "nb_read" argument.
165// It copies the found name in the "name" buffer (without '/'),
166// and updates the "nb_read" argument.
167// It returns 0 if success.
168// It returns 1 if one name length > NAME_MAX_SIZE characters
169///////////////////////////////////////////////////////////////////////////////////
170
171static unsigned int _get_name_from_path( char*          pathname,
172                                         char*          name,
173                                         unsigned int*  nb_read );
174
175////////////////////////////////////////////////////////////////////////////////
176// The following function scan the "pathname" argument, and copies in the
177// "name" buffer the last name in path (leaf name).
178// It returns 0 if success.
179// It returns 1 if one name length > NAME_MAX_SIZE characters
180////////////////////////////////////////////////////////////////////////////////
181static unsigned int _get_last_name( char*   pathname,
182                                    char*   name );
183
184//////////////////////////////////////////////////////////////////////////////////
185// The following function access the Fat-Cache and returns in the "value"
186// argument the content of the FAT slot identified by the "cluster" argument.
187// It loads the missing cluster from block device into cache in case of miss.
188// It returns 0 if success.
189// It returns 1 if error.
190//////////////////////////////////////////////////////////////////////////////////
191
192static unsigned int _get_fat_entry( unsigned int  cluster,
193                                    unsigned int* value );
194
195//////////////////////////////////////////////////////////////////////////////////
196// The following function writes a new "value" in the Fat-Cache, in the slot
197// identified by the "cluster" argument. 
198// It loads the missing cluster from block device into cache in case of miss.
199// It returns 0 if success,
200// It returns 1 if error.
201//////////////////////////////////////////////////////////////////////////////////
202
203static unsigned int _set_fat_entry( unsigned int  cluster,
204                                    unsigned int  value );
205
206//////////////////////////////////////////////////////////////////////////////////
207// The following function introduces the inode identified by the "child" argument,
208// as a new child of the "parent" inode in the Inode-Tree.
209// All checking are supposed to be done by the caller.
210// Nor the File-Cache, neither the block device are modified.
211//////////////////////////////////////////////////////////////////////////////////
212
213static void _add_inode_in_tree( fat_inode_t*  child,
214                                fat_inode_t*  parent );
215
216//////////////////////////////////////////////////////////////////////////////////
217// The following function removes one inode identified by the "inode" argument
218// from the Inode-Tree. All checking are supposed to be done by the caller.
219// Nor the File-Cache, neither the block device are modified.
220//////////////////////////////////////////////////////////////////////////////////
221
222static void _remove_inode_from_tree( fat_inode_t* inode );
223
224//////////////////////////////////////////////////////////////////////////////////
225// This recursive function scan one File-Cache (or Fat-Cache) from root to leaves,
226// to writes all dirty clusters to block device, and reset the dirty bits.
227// The cache is identified by the "root" an "levels" arguments.
228// The "string" argument is only used for debug : inode name or Fat.
229// It returns 0 if success.
230// It returns 1 if error.
231//////////////////////////////////////////////////////////////////////////////////
232
233static unsigned int _update_device_from_cache( unsigned int      levels,
234                                               fat_cache_node_t* root,
235                                               char*             string );
236
237//////////////////////////////////////////////////////////////////////////////////
238// The following function access directly the FS_INFO block on the block device,
239// to update the "first_free_cluster" and "free_clusters_number" values,
240// using only the Fat-Descriptor single block buffer.
241// It return 0 in case of success.
242// It return 1 in case of error.
243//////////////////////////////////////////////////////////////////////////////////
244
245static unsigned int _update_fs_info();
246
247//////////////////////////////////////////////////////////////////////////////
248// The following function read a data field (from one to four bytes)
249// from an unsigned char[] buffer, taking endianness into account.
250// The analysed field is defined by the "offset" and "size" arguments.
251//////////////////////////////////////////////////////////////////////////////
252
253static unsigned int _read_entry( unsigned int    offset,
254                                 unsigned int    size,
255                                 unsigned char*  buffer,
256                                 unsigned int    little_indian );
257
258//////////////////////////////////////////////////////////////////////////////////
259// The following function returns the lba of first sector in DATA region
260// from the cluster index. The cluster index must be larger than 2.
261//////////////////////////////////////////////////////////////////////////////////
262
263static unsigned int _cluster_to_lba( unsigned int cluster );
264
265//////////////////////////////////////////////////////////////////////////////////
266// The following function returns in the "nb_entries" argument the number of files
267// (or directories) contained in a directory identidied by the "inode " pointer.
268// It returns  0 if success.
269// It returns  1 if error.
270//////////////////////////////////////////////////////////////////////////////////
271
272static unsigned int _get_nb_entries( fat_inode_t*   inode,
273                                     unsigned int*  nb_entries );
274
275//////////////////////////////////////////////////////////////////////////////////
276// The following function search in the directory identified by the "parent"
277// inode pointer a child (file or directory) identified by its "name".
278// It returns in the "inode" argument the searched child inode pointer.
279// If the searched name is not found in the Inode-Tree, the function access
280// the "file_cache" associated to the parent directory.
281// If the child exist on block device, the Inode-Tree is updated, and
282// a success code is returned.
283// If the file/dir does not exist on block device, a error code is returned.
284// It returns 0 if inode found.
285// It returns 1 if inode not found.
286// It returns 2 if error in cache access.
287//////////////////////////////////////////////////////////////////////////////////
288
289static unsigned int _get_child_from_parent( fat_inode_t*   parent,
290                                            char*          name,
291                                            fat_inode_t**  inode ); 
292
293/////////////////////////////////////////////////////////////////////////////////
294// For a file (or a directory) identified by the "pathname" argument, the
295// following function returns in the "inode" argument the inode pointer
296// associated to the searched file (or directory), with code (0).
297// If the searched file (or directory) is not found, but the parent directory
298// is found, it returns in the "inode" argument the pointer on the parent inode,
299// with code (1).  Finally, code (2) and code (3) are error codes.
300// Both the Inode-Tree and the involved Cache-Files are updated from the block
301// device in case of miss on one inode during the search in path.
302// Neither the Fat-Cache, nor the block device are updated.
303// It returns 0 if searched inode found
304// It returns 1 if searched inode not found but parent directory found
305// It returns 2 if searched inode not found and parent directory not found
306// It returns 3 if one name too long
307/////////////////////////////////////////////////////////////////////////////////
308
309static unsigned int _get_inode_from_path( char*          pathname,
310                                          fat_inode_t**  inode );
311
312//////////////////////////////////////////////////////////////////////////////////
313// This function computes the length and the number of LFN entries required
314// to store a node name in the "length" and "nb_lfn" arguments.
315// Short name (less than 13 characters) require 1 LFN entry.
316// Medium names (from 14 to 26 characters require 2 LFN entries.
317// Large names (up to 31 characters) require 3 LFN entries.
318// It returns 0 if success.
319// It returns 1 if length larger than 31 characters.
320//////////////////////////////////////////////////////////////////////////////////
321
322static unsigned int _check_name_length( char* name,
323                                        unsigned int* length,
324                                        unsigned int* nb_lfn );
325
326//////////////////////////////////////////////////////////////////////////////////
327// For a node identified by the "inode" argument, this function updates the
328// "size" and "cluster" values in the entry of the parent directory File-Cache.
329// It set the dirty bit in the modified buffer of the parent directory File-Cache.
330//////////////////////////////////////////////////////////////////////////////////
331
332static unsigned int _update_dir_entry( fat_inode_t*  inode );
333
334//////////////////////////////////////////////////////////////////////////////////
335// The following function add new "child" in Cache-File of "parent" directory.
336// It access the File_Cache associated to the parent directory, and scan the
337// clusters allocated to this directory to find the NO_MORE entry.
338// This entry will be the first modified entry in the directory.
339// Regarding the name storage, it uses LFN entries for all names.
340// Therefore, it writes 1, 2, or 3 LFN entries (depending on the child name
341// actual length, it writes one NORMAL entry, and writes the new NOMORE entry.
342// It updates the dentry field in the child inode.
343// It set the dirty bit for all modified File-Cache buffers.
344// The block device is not modified by this function.
345//////////////////////////////////////////////////////////////////////////////////
346
347static unsigned int _add_dir_entry( fat_inode_t* child,
348                                    fat_inode_t* parent );
349
350//////////////////////////////////////////////////////////////////////////////////
351// The following function invalidates all dir_entries associated to the "inode"
352// argument from its parent directory.
353// It set the dirty bit for all modified buffers in parent directory Cache-File.
354// The inode itself is not modified by this function.
355// The block device is not modified by this function.
356//////////////////////////////////////////////////////////////////////////////////
357
358static unsigned int _remove_dir_entry( fat_inode_t*  inode );
359
360//////////////////////////////////////////////////////////////////////////////////
361// The following function add the special entries "." and ".." in the File-Cache
362// of the directory identified by the "child" argument.
363// The parent directory is defined by the "parent" argument.
364// The child directory File-Cache is supposed to be empty.
365// We use two NORMAL entries for these "." and ".." entries.
366// The block device is not modified by this function.
367//////////////////////////////////////////////////////////////////////////////////
368
369static void _add_special_directories( fat_inode_t* child,
370                                      fat_inode_t* parent );
371
372//////////////////////////////////////////////////////////////////////////////////
373// The following function releases all clusters allocated to a file or directory,
374// from the cluster index defined by the "cluster" argument, until the end
375// of the FAT linked list.
376// It calls _get_fat_entry() and _set_fat_entry() functions to scan the FAT,
377// and to update the clusters chaining.
378// The FAT region on block device is updated.
379// It returns 0 if success.
380// It returns 1 if error.
381//////////////////////////////////////////////////////////////////////////////////
382
383static unsigned int _clusters_release( unsigned int cluster );
384
385//////////////////////////////////////////////////////////////////////////////////
386// This function allocate "nb_clusters_more" new clusters to a file (or directory)
387// identified by the "inode" pointer. It allocates also the associated buffers
388// and buffer descriptors in the Cache-File.
389// It calls _get_fat_entry() and _set_fat_entry() functions to update the
390// clusters chaining in the Cache-Fat. The FAT region on block device is updated.
391// It returns 0 if success.
392// It returns 1 if error.
393//////////////////////////////////////////////////////////////////////////////////
394
395static unsigned int _clusters_allocate( fat_inode_t* inode, 
396                                        unsigned int nb_clusters_current,
397                                        unsigned int nb_clusters_more );
398
399//////////////////////////////////////////////////////////////////////////////////
400// This recursive function scan one File-Cache (or Fat-Cache) from root to leaves.
401// The cache 64-Tree infrastructure is kept, but all memory allocated for 4 Kbytes
402// buffers, and for buffer descriptors (in leaves) is released.
403// The cache is identified by the "root" an "levels" arguments.
404// It should not contain any dirty clusters.
405// It returns 0 if success.
406// It returns 1 if error.
407//////////////////////////////////////////////////////////////////////////////////
408
409static unsigned int _release_cache_memory( fat_cache_node_t*  root,
410                                           unsigned int       levels );
411
412//////////////////////////////////////////////////////////////////////////////////
413// The following function allocates and initializes a new inode,
414// using the values defined by the arguments.
415// If the "cache_allocate" argument is true ans empty cache is allocated.
416// The Fat-Cache is initialised as empty: all children set to NULL.
417// It returns a pointer on the new inode.
418//////////////////////////////////////////////////////////////////////////////////
419
420static fat_inode_t* _allocate_one_inode( char*        name,
421                                         unsigned int is_dir,
422                                         unsigned int cluster,
423                                         unsigned int size,
424                                         unsigned int count,
425                                         unsigned int dentry,
426                                         unsigned int cache_allocate );
427
428//////////////////////////////////////////////////////////////////////////////////
429// The following function allocates one 4 Kbytes buffer and associated cluster
430// descriptor for the file (or directory) identified by the "inode" argument,
431// and updates the Cache_File slot identified by the "cluster_id" argument.
432// The File-Cache slot must be empty.
433// It updates the cluster descriptor, using the "cluster" argument, that is
434// the cluster index in FAT.  The cluster descriptor dirty field is set.
435// It traverse the 64-tree Cache-file from top to bottom to find the last level.
436//////////////////////////////////////////////////////////////////////////////////
437
438static void _allocate_one_buffer( fat_inode_t*    inode,
439                                  unsigned int    cluster_id,
440                                  unsigned int    cluster );
441
442//////////////////////////////////////////////////////////////////////////////////
443// The following function allocates one free cluster from the FAT "heap" of free
444// clusters, and returns the cluster index in the "cluster" argument.
445// It updates the FAT slot, and the two FAT global variables: first_free_cluster,
446// and free_clusters_number.
447// It returns O if success.
448// It returns 1 if error.
449//////////////////////////////////////////////////////////////////////////////////
450
451static unsigned int _allocate_one_cluster( unsigned int*  cluster );
452
453/////////////////////////////////////////////////////////////////////////////
454// This function remove from the file system a file or a directory
455// identified by the "inode" argument.
456// The remove condition must be checked by the caller.
457// The relevant lock(s) must have been taken by te caller.
458// It returns O if success.
459// It returns 1 if error.
460/////////////////////////////////////////////////////////////////////////////
461
462static unsigned int _remove_node_from_fs( fat_inode_t* inode );
463
464/////////////////////////////////////////////////////////////////////////////
465// This function return the cluster index and the size for a file
466// identified by the "pathname" argument, scanning directly the block
467// device DATA region.
468// It is intended to be called only by the _fat_load_no_cache() function,
469// it does not use the dynamically allocated File Caches, but uses only
470// the 4 Kbytes _fat_buffer_data.
471// It returns 0 if success.
472// It returns 1 if error.
473/////////////////////////////////////////////////////////////////////////////
474
475static unsigned int _file_info_no_cache( char*          pathname,
476                                         unsigned int*  file_cluster,
477                                         unsigned int*  file_size );
478
479/////////////////////////////////////////////////////////////////////////////
480// This function scan directly the FAT region on the block device,
481// and returns in the "next" argument the value stored in the fat slot
482// identified by the "cluster" argument.
483// It is intended to be called only by the _fat_load_no_cache() function,
484// as it does not use the dynamically allocated Fat-Cache, but uses only
485// the 4 Kbytes _fat_buffer_fat.
486// It returns 0 if success.
487// It returns 1 if error.
488/////////////////////////////////////////////////////////////////////////////
489
490static unsigned int _next_cluster_no_cache( unsigned int   cluster,
491                                            unsigned int*  next );
492
493
494//////////////////////////////////////////////////////////////////////////////////
495// The following functions return the length or the size of a FAT field,
496// identified by an (offset,length) mnemonic defined in the fat32.h file.
497//////////////////////////////////////////////////////////////////////////////////
498
499static inline int get_length( int offset , int length ) { return length; }
500
501static inline int get_offset( int offset , int length ) { return offset; }
502
503
504
505
506
507//////////////////////////////////////////////////////////////////////////////////
508//////////////////////////////////////////////////////////////////////////////////
509//                  Static functions definition
510//////////////////////////////////////////////////////////////////////////////////
511//////////////////////////////////////////////////////////////////////////////////
512
513#if GIET_DEBUG_FAT
514///////////////////////////////////////////////////
515static void _display_one_block( unsigned char* buf,
516                                char*          string,
517                                unsigned int   block_id )
518{
519    unsigned int line;
520    unsigned int word;
521
522    _printf("\n***  <%s>  block %x  ***********************************\n",
523            string , block_id );
524
525    for ( line = 0 ; line < 16 ; line++ )
526    {
527        // display line index
528        _printf("%x : ", line );
529
530        // display 8*4 bytes hexa
531        for ( word=0 ; word<8 ; word++ )
532        {
533            unsigned int byte  = (line<<5) + (word<<2);
534            unsigned int hexa  = (buf[byte  ]<<24) |
535                                 (buf[byte+1]<<16) |
536                                 (buf[byte+2]<< 8) |
537                                 (buf[byte+3]      );
538            _printf(" %X |", hexa );
539        }
540        _printf("\n");
541    }
542    _printf("*******************************************************************\n"); 
543} // end _display_one_block() 
544#endif
545
546
547
548#if GIET_DEBUG_FAT
549/////////////////////////////////////
550static void _display_fat_descriptor()
551{
552    _printf("\n###############  FAT DESCRIPTOR  ################################" 
553            "\nFAT initialised                  %x"
554            "\nBlock Size  (bytes)              %x"
555            "\nCluster Size  (bytes)            %x"
556            "\nFAT region first lba             %x"
557            "\nFAT region size (blocks)         %x"
558            "\nDATA region first lba            %x"
559            "\nDATA region size (blocks)        %x"
560            "\nNumber of free clusters          %x"
561            "\nFirst free cluster index         %x" 
562            "\nFat_cache_levels                 %d" 
563            "\n#################################################################\n",
564            _fat.initialised,
565            _fat.sector_size,
566            _fat.cluster_size,
567            _fat.fat_lba,
568            _fat.fat_sectors,
569            _fat.data_lba,
570            _fat.data_sectors,
571            _fat.free_clusters_number,
572            _fat.first_free_cluster,
573            _fat.fat_cache_levels );
574
575} // end _display_fat_descriptor()
576#endif
577
578
579
580#if GIET_DEBUG_FAT
581////////////////////////////////////////////////////////
582static void _display_clusters_list( fat_inode_t* inode )
583{
584    _printf("\n**************** clusters for <%s> ***********************\n", inode->name );
585    unsigned int next;
586    unsigned int n       = 0;
587    unsigned int current = inode->cluster;
588    while( (current < END_OF_CHAIN_CLUSTER_MIN) && (n < 1024) )
589    {
590        _get_fat_entry( current , &next );
591        _printf(" > %X", current );
592        n++;
593        if ( (n & 0x7) == 0 ) _printf("\n");
594        current = next;
595    }
596    _printf("\n");
597}  // end _display_clusters_list()
598#endif
599
600
601
602/////////////////////////////////////////////////////////////////////////////////
603static int _fat_ioc_access( unsigned int use_irq,       // descheduling if non zero
604                            unsigned int to_mem,        // read / write
605                            unsigned int lba,           // first sector on device
606                            unsigned int buf_vaddr,     // memory buffer vaddr
607                            unsigned int count )        // number of sectors
608{
609    // compute memory buffer physical address
610    unsigned int       flags;         // for _v2p_translate
611    unsigned long long buf_paddr;     // buffer physical address
612
613    if ( ((_get_mmu_mode() & 0x4) == 0 ) || USE_IOC_RDK )  // identity
614    { 
615        buf_paddr = (unsigned long long)buf_vaddr;
616    }
617    else                                // V2P translation required
618    {
619        buf_paddr = _v2p_translate( buf_vaddr , &flags );
620    }
621
622#if (GIET_DEBUG_FAT & 1)
623if ( _get_proctime() > GIET_DEBUG_FAT )
624_printf("\n[DEBUG FAT] _fat_ioc_access() : enters at cycle %d\n"
625        "  to_mem = %d / vaddr = %x / paddr = %l / sectors = %d / lba = %x\n",
626        _get_proctime(), to_mem, buf_vaddr, buf_paddr, count, lba );
627#endif
628
629
630#if GIET_NO_HARD_CC     // L1 cache inval (virtual addresses)
631    if ( to_mem ) _dcache_buf_invalidate( buf_vaddr, count<<9 );
632#endif
633
634
635#if   ( USE_IOC_BDV )   // call the proper driver
636    return( _bdv_access( use_irq , to_mem , lba , buf_paddr , count ) ); 
637#elif ( USE_IOC_HBA )
638    return( _hba_access( use_irq , to_mem , lba , buf_paddr , count ) );
639#elif ( USE_IOC_SDC )
640    return( _sdc_access( use_irq , to_mem , lba , buf_paddr , count ) );
641#elif ( USE_IOC_SPI )
642    return( _spi_access( use_irq , to_mem , lba , buf_paddr , count ) );
643#elif ( USE_IOC_RDK )
644    return( _rdk_access( use_irq , to_mem , lba , buf_paddr , count ) );
645#else
646    _printf("\n[FAT ERROR] in _fat_ioc_access() : no IOC driver\n");
647    _exit();
648#endif
649
650}  // end _fat_ioc_access()
651
652
653
654
655/////////////////////////////////////////////////////////////////////
656static inline unsigned int _get_levels_from_size( unsigned int size )
657{ 
658    if      ( size <= (1<<18) ) return 1;     // 64 clusters == 256 Kbytes
659    else if ( size <= (1<<24) ) return 2;     // 64 * 64 clusters => 16 Mbytes
660    else if ( size <= (1<<30) ) return 3;     // 64 * 64 * 64 cluster => 1 Gbytes
661    else                        return 4;     // 64 * 64 * 64 * 64 clusters
662}
663
664
665
666////////////////////////////////////////////////////////
667static unsigned int _read_entry( unsigned int    offset,
668                                 unsigned int    size,
669                                 unsigned char*  buffer,
670                                 unsigned int    little_endian )
671{
672    unsigned int n;
673    unsigned int res  = 0;
674
675    if ( little_endian)
676    {
677        for( n = size ; n > 0 ; n-- ) res = (res<<8) | buffer[offset+n-1];
678    }
679    else
680    {
681        for( n = 0 ; n < size ; n++ ) res = (res<<8) | buffer[offset+n];
682    }
683    return res;
684
685}  // end _read_entry
686
687
688
689//////////////////////////////////////////////////////////////////
690static inline unsigned int _cluster_to_lba( unsigned int cluster )       
691{
692    if ( cluster < 2 )
693    { 
694        _printf("\n[FAT ERROR] in _cluster_to_lba() cluster smaller than 2\n"); 
695        _exit();
696    }
697
698   return  ((cluster - 2) << 3) + _fat.data_lba;
699}
700
701
702//////////////////////////////////////////////////////
703static inline unsigned char _to_lower(unsigned char c)
704{
705   if (c >= 'A' && c <= 'Z') return (c | 0x20);
706   else                      return c;
707}
708
709
710//////////////////////////////////////////////////////
711static inline unsigned char _to_upper(unsigned char c)
712{
713   if (c >= 'a' && c <= 'z') return (c & ~(0x20));
714   else                      return c;
715}
716
717
718
719///////////////////////////////////////////////////////////////////////////
720static unsigned int _get_name_from_path( char*          pathname,  // input
721                                         char*          name,      // output
722                                         unsigned int*  nb_read )  // input & output   
723{
724    // skip leading "/" character
725    if ( pathname[*nb_read] == '/' ) *nb_read = *nb_read + 1;
726
727    // initialises current indexes
728    unsigned int i = *nb_read;
729    unsigned int j = 0;
730   
731    while ( (pathname[i] != '/') && (pathname[i] != 0) )
732    {
733        name[j++] = pathname[i++];   
734        if ( j > NAME_MAX_SIZE ) return 1;
735    }
736
737    // set end of string
738    name[j] = 0;
739
740    // skip trailing "/" character
741    if ( pathname[i] == '/' ) *nb_read += j+1;
742    else                      *nb_read += j;
743
744    return 0;
745}
746
747
748
749////////////////////////////////////////////////////////////////////
750static unsigned int _get_last_name( char*   pathname,       // input
751                                    char*   name )          // output
752{
753    unsigned int nb_read = 0;     
754    while ( pathname[nb_read] != 0 )
755    {
756        if ( _get_name_from_path( pathname, name, &nb_read ) ) return 1;
757    }
758
759    return 0;
760}   // end _get_last_name()
761
762
763
764////////////////////////////////////////////////////////////////////////////////
765static void _get_name_from_short( unsigned char* buffer,  // input:  SFN dir_entry
766                                  char*          name )   // output: name
767{
768    unsigned int i;
769    unsigned int j = 0;
770
771    // get name
772    for ( i = 0; i < 8 && buffer[i] != ' '; i++ )
773    {
774        name[j] = _to_lower( buffer[i] );
775        j++;
776    }
777
778    // get extension
779    for ( i = 8; i < 8 + 3 && buffer[i] != ' '; i++ )
780    {
781        // we entered the loop so there is an extension. add the dot
782        if ( i == 8 )
783        {
784            name[j] = '.';
785            j++;
786        }
787
788        name[j] = _to_lower( buffer[i] );
789        j++;
790    }
791
792    name[j] = '\0';
793}
794
795///////////////////////////////////////////////////////////////////////////////
796static void _get_name_from_long( unsigned char*  buffer, // input : LFN dir_entry
797                                 char*           name )  // output : name
798{
799    unsigned int   name_offset         = 0;
800    unsigned int   buffer_offset       = get_length(LDIR_ORD);
801    unsigned int   l_name_1            = get_length(LDIR_NAME_1);
802    unsigned int   l_name_2            = get_length(LDIR_NAME_2);
803    unsigned int   l_name_3            = get_length(LDIR_NAME_3);
804    unsigned int   l_attr              = get_length(LDIR_ATTR);
805    unsigned int   l_type              = get_length(LDIR_TYPE);
806    unsigned int   l_chksum            = get_length(LDIR_CHKSUM);
807    unsigned int   l_rsvd              = get_length(LDIR_RSVD);
808
809    unsigned int j            = 0;
810    unsigned int eof          = 0;
811
812    while ( (buffer_offset != DIR_ENTRY_SIZE)  && (!eof) )
813    {
814        while (j != l_name_1 && !eof )
815        {
816            if ( (buffer[buffer_offset] == 0x00) || 
817                 (buffer[buffer_offset] == 0xFF) )
818            {
819                eof = 1;
820                continue;
821            }
822            name[name_offset] = buffer[buffer_offset];
823            buffer_offset += 2;
824            j += 2;
825            name_offset++;
826        }
827
828        buffer_offset += (l_attr + l_type + l_chksum);
829        j = 0;
830
831        while (j != l_name_2 && !eof )
832        {
833            if ( (buffer[buffer_offset] == 0x00) || 
834                 (buffer[buffer_offset] == 0xFF) )
835            {
836                eof = 1;
837                continue;
838            }
839            name[name_offset] = buffer[buffer_offset];
840            buffer_offset += 2;
841            j += 2;
842            name_offset++;
843        }
844
845        buffer_offset += l_rsvd;
846        j = 0;
847
848        while (j != l_name_3 && !eof )
849        {
850            if ( (buffer[buffer_offset] == 0x00) || 
851                 (buffer[buffer_offset] == 0xFF) )
852            {
853                eof = 1;
854                continue;
855            }
856            name[name_offset] = buffer[buffer_offset];
857            buffer_offset += 2;
858            j += 2;
859            name_offset++;
860        }
861    }
862    name[name_offset] = 0;
863} // end get_name_from_long()
864
865
866
867
868////////////////////////////////////////////////////////////
869static fat_inode_t* _allocate_one_inode( char*        name,
870                                         unsigned int is_dir,
871                                         unsigned int cluster,
872                                         unsigned int size, 
873                                         unsigned int count,
874                                         unsigned int dentry,
875                                         unsigned int cache_allocate )
876{
877    fat_inode_t* new_inode  = _malloc( sizeof(fat_inode_t) );
878
879    new_inode->parent   = NULL;                 // set by _add_inode_in_tree()
880    new_inode->next     = NULL;                 // set by _add_inode_in_tree()
881    new_inode->child    = NULL;                 // set by _add_inode_in_tree()
882    new_inode->cluster  = cluster;
883    new_inode->size     = size; 
884    new_inode->cache    = NULL;
885    new_inode->levels   = 0;
886    new_inode->count    = count;
887    new_inode->is_dir   = (is_dir != 0);
888    new_inode->dentry   = dentry;             
889
890    _strcpy( new_inode->name , name ); 
891
892    if ( cache_allocate )
893    {
894        fat_cache_node_t* new_cache  = _malloc( sizeof(fat_cache_node_t) );
895
896        new_inode->cache    = new_cache;
897        new_inode->levels   = _get_levels_from_size( size );
898       
899        unsigned int index;
900        for ( index = 0 ; index < 64 ; index ++ )  new_cache->children[index] = NULL;
901    }
902
903    return new_inode;
904}   // end _allocate_one_inode()
905
906
907
908
909////////////////////////////////////////////////////
910static void _add_inode_in_tree( fat_inode_t*  child,
911                                fat_inode_t*  parent )
912{
913    child->parent = parent;
914    child->next   = parent->child;
915    parent->child = child;
916}   // end _add_inode-in_tree()
917
918
919
920
921//////////////////////////////////////////////////////////
922static void _remove_inode_from_tree( fat_inode_t*  inode )
923{
924    fat_inode_t*  current;
925    fat_inode_t*  prev = inode->parent->child;
926
927    if ( inode == prev )  // removed inode is first in its linked list
928    {
929        inode->parent->child = inode->next;
930    }
931    else                  // removed inode is not the first
932    {
933        for( current = prev->next ; current ; current = current->next )
934        {
935            if ( current == inode )
936            {
937                prev->next = current->next;
938            }
939            prev = current;
940        }   
941    }   
942}  // end _delete_one_inode()
943
944
945
946
947//////////////////////////////////////////////////////////////////////
948static unsigned int _get_buffer_from_cache( fat_inode_t*        inode,
949                                            unsigned int        cluster_id,
950                                            fat_cache_desc_t**  desc )
951{
952    // get cache pointer and levels
953    fat_cache_node_t*   node;         // pointer on a 64-tree node
954    unsigned int        level;        // cache level
955
956    if ( inode == NULL )   // searched cache is the Fat-Cache
957    {
958        node   = _fat.fat_cache_root;
959        level  = _fat.fat_cache_levels;
960
961#if (GIET_DEBUG_FAT & 1)
962if ( _get_proctime() > GIET_DEBUG_FAT )
963_printf("\n[DEBUG FAT] _get_buffer_from_cache() : enters in FAT-Cache"
964        " for cluster_id = %d\n", cluster_id );
965#endif
966
967    }
968    else                   // searched cache is a File-Cache
969    {
970        node   = inode->cache;
971        level  = inode->levels;
972
973#if (GIET_DEBUG_FAT & 1)
974if ( _get_proctime() > GIET_DEBUG_FAT )
975_printf("\n[DEBUG FAT] _get_buffer_from_cache() : enters in File-Cache <%s>"
976        " for cluster_id = %d\n", inode->name , cluster_id );
977#endif
978
979    }
980
981    // search the 64-tree cache from top to bottom
982    while ( level )
983    {
984        // compute child index at each level
985        unsigned int index = (cluster_id >> (6*(level-1))) & 0x3F;
986
987        if ( level == 1 )        // last level => children are cluster descriptors
988        {
989            fat_cache_desc_t* pdesc = (fat_cache_desc_t*)node->children[index];
990
991            if ( pdesc == NULL )      // miss
992            {
993                // allocate one cluster descriptor and one 4K buffer
994                unsigned char* buf = _malloc( 4096 );
995                pdesc              = _malloc( sizeof(fat_cache_desc_t) );
996
997                // get missing cluster index lba
998                unsigned int lba;
999                unsigned int next;
1000                unsigned int current = inode->cluster;
1001                unsigned int count   = cluster_id;
1002
1003                if ( inode == NULL )      // searched cache is the Fat-Cache
1004                {
1005
1006#if (GIET_DEBUG_FAT & 1)
1007if ( _get_proctime() > GIET_DEBUG_FAT )
1008_printf("\n[DEBUG FAT] _get_buffer_from_cache() : miss in FAT-Cache for cluster_id %d\n",
1009        cluster_id );
1010#endif
1011                    lba = _fat.fat_lba + (cluster_id << 3);
1012                }
1013                else                      // searched cache is a File-Cache
1014                {
1015
1016#if (GIET_DEBUG_FAT & 1)
1017if ( _get_proctime() > GIET_DEBUG_FAT )
1018_printf("\n[DEBUG FAT] _get_buffer_from_cache() : miss in File-Cache <%s> "
1019        "for cluster_id %d\n", inode->name, cluster_id );
1020#endif
1021                    while ( count )
1022                    { 
1023                        if ( _get_fat_entry( current , &next ) ) return 1;
1024                        current = next;
1025                        count--;
1026                    }
1027                    lba = _cluster_to_lba( current );
1028                }
1029
1030                // load one cluster (8 blocks) from block device
1031                if ( _fat_ioc_access( 1,         // descheduling
1032                                      1,         // to memory
1033                                      lba,
1034                                      (unsigned int)buf,
1035                                      8 ) )
1036                {
1037                    _printf("\n[FAT ERROR] in _get_buffer_from_cache()"
1038                            " : cannot access block device for lba = %x\n", lba );
1039                    return 1;
1040                }
1041
1042                // update cache and buffer descriptor
1043                node->children[index] = pdesc;
1044                pdesc->lba     = lba;
1045                pdesc->buffer  = buf;
1046                pdesc->dirty   = 0;
1047
1048#if (GIET_DEBUG_FAT & 1)
1049if ( _get_proctime() > GIET_DEBUG_FAT )
1050_printf("\n[DEBUG FAT] _get_buffer_from_cache() : buffer loaded from device"
1051        " at vaddr = %x\n", (unsigned int)buf );
1052#endif
1053            }
1054
1055            // return pdesc pointer
1056            *desc = pdesc;
1057
1058            // prepare next iteration
1059            level--;
1060        }
1061        else                      // not last level => children are 64-tree nodes
1062        {
1063            fat_cache_node_t* child = (fat_cache_node_t*)node->children[index];
1064            if ( child == NULL )  // miss
1065            {
1066                // allocate a cache node if miss
1067                child = (fat_cache_node_t*)_malloc( sizeof(fat_cache_node_t) );
1068                node->children[index] = child;   
1069            }
1070
1071            // prepare next iteration
1072            node = child;
1073            level--;
1074        }
1075    } // end while
1076
1077    return 0;
1078}  // end _get_buffer_from_cache()
1079
1080
1081
1082
1083/////////////////////////////////////
1084static unsigned int _update_fs_info()
1085{
1086    // update buffer if miss
1087    if ( _fat.fs_info_lba != _fat.block_buffer_lba )
1088    {
1089        if ( _fat_ioc_access( 1,                 // descheduling
1090                              1,                 // read
1091                              _fat.fs_info_lba, 
1092                              (unsigned int)_fat.block_buffer, 
1093                              1 ) )              // one block
1094        {
1095            _printf("\n[FAT_ERROR] in _update_fs_info() cannot read block\n");
1096            return 1;
1097        }
1098        _fat.block_buffer_lba = _fat.fs_info_lba;
1099    }
1100
1101    // update FAT buffer
1102    unsigned int* ptr;
1103    ptr  = (unsigned int*)(_fat.block_buffer + get_offset(FS_FREE_CLUSTERS) );
1104    *ptr = _fat.free_clusters_number;
1105
1106    ptr  = (unsigned int*)(_fat.block_buffer + get_offset(FS_FREE_CLUSTER_HINT) );
1107    *ptr = _fat.first_free_cluster;
1108   
1109    // write bloc to FAT
1110    if ( _fat_ioc_access( 1,                // descheduling
1111                          0,                // write
1112                          _fat.fs_info_lba,
1113                          (unsigned int)_fat.block_buffer, 
1114                          1 ) )             // one block
1115    {
1116        _printf("\n[FAT_ERROR] in _update_fs_info() cannot write block\n");
1117        return 1;
1118    }
1119
1120#if (GIET_DEBUG_FAT & 1)
1121if ( _get_proctime() > GIET_DEBUG_FAT )
1122_printf("\n[DEBUG FAT] _update_fs_info() : nb_free = %x / first_free = %x\n",
1123        _fat.free_clusters_number , _fat.first_free_cluster );
1124#endif
1125
1126    return 0;
1127}  // end _update_fs_info()
1128
1129
1130
1131/////////////////////////////////////////////////////////////////
1132static inline unsigned int _get_fat_entry( unsigned int  cluster,
1133                                           unsigned int* value )
1134{
1135    // compute cluster_id & entry_id in FAT
1136    // a FAT cluster is an array of 1024 unsigned int entries
1137    unsigned int       cluster_id = cluster >> 10;       
1138    unsigned int       entry_id   = cluster & 0x3FF;
1139
1140    // get pointer on the relevant cluster descriptor in FAT cache
1141    fat_cache_desc_t*  pdesc;
1142    unsigned int*      buffer;
1143    if ( _get_buffer_from_cache( NULL,               // Fat-Cache
1144                                 cluster_id,
1145                                 &pdesc ) ) return 1;
1146
1147    // get value from FAT slot
1148    buffer = (unsigned int*)pdesc->buffer;
1149    *value = buffer[entry_id];
1150
1151    return 0;
1152}  // end _get_fat_entry()
1153
1154
1155
1156////////////////////////////////////////////////////////////////
1157static inline unsigned int _set_fat_entry( unsigned int cluster, 
1158                                           unsigned int value  )
1159{
1160    // compute cluster_id & entry_id in FAT
1161    // a FAT cluster is an array of 1024 unsigned int entries
1162    unsigned int cluster_id = cluster >> 10;
1163    unsigned int entry_id   = cluster & 0x3FF;
1164
1165    // get pointer on the relevant cluster descriptor in FAT cache
1166    fat_cache_desc_t*  pdesc;
1167    unsigned int*      buffer; 
1168    if ( _get_buffer_from_cache( NULL,               // Fat-Cache
1169                                 cluster_id,
1170                                 &pdesc ) )  return 1;           
1171
1172    // set value into FAT slot
1173    buffer           = (unsigned int*)pdesc->buffer;
1174    buffer[entry_id] = value;
1175    pdesc->dirty     = 1;
1176
1177    return 0;
1178} // end _set_fat_entry()
1179
1180
1181
1182//////////////////////////////////////////////////////
1183static void _allocate_one_buffer( fat_inode_t*  inode,
1184                                  unsigned int  cluster_id,
1185                                  unsigned int  cluster )
1186{
1187    // search the 64-tree cache from top to bottom
1188    fat_cache_node_t*  node   = inode->cache;
1189    unsigned int       level  = inode->levels;
1190
1191    while ( level )
1192    {
1193        // compute child index
1194        unsigned int index = (cluster_id >> (6*(level-1))) & 0x3F;
1195
1196        if ( level == 1 )        // last level => children are cluster descriptors
1197        {
1198            fat_cache_desc_t* pdesc = (fat_cache_desc_t*)node->children[index];
1199            if ( pdesc != NULL )      // slot not empty!!!
1200            {
1201                _printf("\n[FAT ERROR] in allocate_one buffer() : slot not empty "
1202                        "in File-Cache <%s> / cluster_id = %d\n", inode->name , cluster_id );
1203                _exit();
1204            }
1205 
1206            // allocate a cluster descriptor and a 4K buffer
1207            pdesc = _malloc( sizeof(fat_cache_desc_t) );
1208            unsigned char* buffer = _malloc( 4096 );
1209
1210#if (GIET_DEBUG_FAT & 1)
1211if ( _get_proctime() > GIET_DEBUG_FAT )
1212_printf("\n[DEBUG FAT] _allocate_one_buffer() : buffer allocated to <%s> for cluster_id %d\n",
1213        inode->name, cluster_id );
1214#endif
1215
1216            // update cache and pdesc
1217            node->children[index] = pdesc;
1218            pdesc->lba     = _cluster_to_lba( cluster );
1219            pdesc->buffer  = buffer;
1220            pdesc->dirty   = 1;
1221
1222            // prepare next iteration
1223            level--;
1224        }
1225        else                      // not last level => children are 64-tree nodes
1226        {
1227            fat_cache_node_t* child = (fat_cache_node_t*)node->children[index];
1228            if ( child == NULL )  // miss
1229            {
1230                // allocate a cache node if miss
1231                child = (fat_cache_node_t*)_malloc( sizeof(fat_cache_node_t) );
1232                node->children[index] = child;   
1233            }
1234
1235            // prepare next iteration
1236            node  = child;
1237            level--;
1238        }
1239    } // end while
1240} // end _allocate_one_buffer
1241
1242
1243
1244
1245///////////////////////////////////////////////////////////////////
1246static unsigned int _allocate_one_cluster( unsigned int*  cluster ) 
1247{
1248    unsigned int nb_free = _fat.free_clusters_number;
1249    unsigned int free    = _fat.first_free_cluster;
1250
1251    // scan FAT to get next free cluster index
1252    unsigned int current = free;
1253    unsigned int found   = 0;
1254    unsigned int max     = (_fat.data_sectors >> 3);
1255    unsigned int value;
1256    do
1257    {
1258        // increment current
1259        current++;
1260
1261        // get FAT entry indexed by current
1262        if ( _get_fat_entry( current , &value ) ) return 1;
1263        // test if free
1264        if ( value == FREE_CLUSTER ) found = 1;
1265    }
1266    while ( (current < max) && (found == 0) );
1267       
1268    // check found 
1269    if ( found == 0 )
1270    {
1271        _printf("\n[FAT_ERROR] in _allocate_one_cluster() : unconsistent FAT state");
1272        return 1;
1273    }
1274
1275    // update allocated FAT slot
1276    if ( _set_fat_entry( free , END_OF_CHAIN_CLUSTER_MAX ) ) return 1;
1277
1278    // update FAT descriptor global variables
1279    _fat.free_clusters_number = nb_free - 1;
1280    _fat.first_free_cluster   = current;
1281
1282#if (GIET_DEBUG_FAT & 1)
1283if ( _get_proctime() > GIET_DEBUG_FAT )
1284_printf("\n[DEBUG FAT] _allocate_one_cluster() : cluster = %x / first_free = %x\n",
1285        free , current );
1286#endif
1287
1288    // returns free cluster index
1289    *cluster = free;
1290    return 0;
1291
1292}  // end _allocate_one_cluster()
1293
1294
1295
1296
1297//////////////////////////////////////////////////////////////////////////
1298static unsigned int _update_device_from_cache( unsigned int        levels,
1299                                               fat_cache_node_t*   root,
1300                                               char*               string )
1301{
1302    unsigned int index;
1303    unsigned int ret = 0;
1304
1305    if ( levels == 1 )  // last level => children are cluster descriptors
1306    {
1307        for( index = 0 ; index < 64 ; index++ )
1308        { 
1309            fat_cache_desc_t* pdesc = root->children[index];
1310            if ( pdesc != NULL )
1311            { 
1312                // update cluster on device if dirty
1313                if ( pdesc->dirty )
1314                {
1315                    if ( _fat_ioc_access( 1,           // descheduling
1316                                          0,           // to block device
1317                                          pdesc->lba,
1318                                          (unsigned int)pdesc->buffer,
1319                                          8 ) )
1320                    {
1321                        _printf("\n[FAT_ERROR] in _update_device from_cache() : "
1322                                " cannot access lba = %x\n", pdesc->lba );
1323                        ret = 1;
1324                    }
1325                    else
1326                    {
1327                        pdesc->dirty = 0;
1328
1329#if (GIET_DEBUG_FAT & 1)
1330if ( _get_proctime() > GIET_DEBUG_FAT )
1331_printf("\n[DEBUG FAT] _update_device_from_cache() : cluster_id = %d for <%s>\n",
1332        index , string );
1333#endif
1334
1335                    }
1336                }
1337            }
1338        }
1339    }
1340    else               // not the last level = recursive call on each children
1341    {
1342        for( index = 0 ; index < 64 ; index++ )
1343        { 
1344            fat_cache_node_t* pnode = root->children[index];
1345            if ( pnode != NULL )
1346            {
1347                if ( _update_device_from_cache( levels - 1,
1348                                                root->children[index],
1349                                                string ) ) ret = 1;
1350            }   
1351        }
1352    }
1353    return ret;
1354}  // end _update_device_from_cache()
1355
1356
1357
1358///////////////////////////////////////////////////////////////////
1359static unsigned int _release_cache_memory( fat_cache_node_t*  root,
1360                                           unsigned int       levels )
1361{
1362    unsigned int index;
1363    unsigned int ret = 0;
1364
1365    if ( levels == 1 )  // last level => children are cluster descriptors
1366    {
1367        for( index = 0 ; index < 64 ; index++ )
1368        { 
1369            fat_cache_desc_t* pdesc = root->children[index];
1370
1371            if ( pdesc != NULL )
1372            { 
1373                // check dirty
1374                if ( pdesc->dirty )
1375                {
1376                    _printf("\n[FAT_ERROR] in _release_cache_memory() : dirty cluster\n");
1377                    ret = 1;
1378                }
1379                else
1380                {
1381                    _free( pdesc->buffer );
1382                    _free( pdesc );
1383                    root->children[index] = NULL;
1384                }
1385            }
1386        }
1387    }
1388    else               // not the last level = recursive call on each children
1389    {
1390        for( index = 0 ; index < 64 ; index++ )
1391        { 
1392            fat_cache_node_t*    cnode = root->children[index];
1393
1394            if ( cnode != NULL ) ret   = _release_cache_memory( root->children[index],
1395                                                                levels - 1 );
1396        }
1397    }
1398    return ret;
1399}  // end _release_cache_memory()
1400
1401
1402
1403
1404
1405/////////////////////////////////////////////////////////////
1406static unsigned int _clusters_allocate( fat_inode_t* inode, 
1407                                        unsigned int nb_current_clusters,
1408                                        unsigned int nb_required_clusters )
1409{
1410    // Check if FAT contains enough free clusters
1411    if ( nb_required_clusters > _fat.free_clusters_number )
1412    {
1413        _printf("\n[FAT ERROR] in _clusters_allocate() : required_clusters = %d"
1414                " / free_clusters = %d\n", nb_required_clusters , _fat.free_clusters_number );
1415        return 1;
1416    }
1417
1418#if (GIET_DEBUG_FAT & 1)
1419if ( _get_proctime() > GIET_DEBUG_FAT )
1420_printf("\n[DEBUG FAT] _clusters_allocate() : enters for <%s> / nb_current_clusters = %d "
1421        "/ nb_required_clusters = %d\n", 
1422        inode->name , nb_current_clusters , nb_required_clusters );
1423#endif
1424 
1425    // compute last allocated cluster index when (nb_current_clusters > 0)
1426    unsigned int current = inode->cluster;
1427    unsigned int next;
1428    unsigned int last;
1429    if ( nb_current_clusters )   // clusters allocated => search last
1430    {   
1431        while ( current < END_OF_CHAIN_CLUSTER_MIN )
1432        {
1433            // get next cluster
1434            if ( _get_fat_entry( current , &next ) )  return 1;
1435            last    = current;
1436            current = next;
1437        }
1438    } 
1439
1440    // Loop on the new clusters to be allocated
1441    // if (nb_current_clusters == 0) the first new cluster index must
1442    //                               be written in inode->cluster field
1443    // if (nb_current_clusters >  0) the first new cluster index must
1444    //                               be written in FAT[last]
1445    unsigned int      cluster_id;
1446    unsigned int      new;
1447    for ( cluster_id = nb_current_clusters ; 
1448          cluster_id < (nb_current_clusters + nb_required_clusters) ; 
1449          cluster_id ++ )
1450    {
1451        // allocate one cluster on block device
1452        if ( _allocate_one_cluster( &new ) ) return 1;
1453
1454        // allocate one 4K buffer to File-Cache
1455        _allocate_one_buffer( inode,
1456                              cluster_id,
1457                              new );
1458
1459        if ( cluster_id == 0 )  // update inode
1460        {
1461            inode->cluster = new;
1462        }
1463        else                    // update FAT
1464        {
1465            if ( _set_fat_entry( last , new ) ) return 1;
1466        }
1467
1468#if (GIET_DEBUG_FAT & 1)
1469if ( _get_proctime() > GIET_DEBUG_FAT )
1470_printf("\n[DEBUG FAT] _clusters_allocate() : done for cluster_id = %d / cluster = %x\n",
1471        cluster_id , new );
1472#endif
1473
1474        // update loop variables
1475        last = new;
1476
1477    } // end for loop
1478
1479    // update FAT : last slot should contain END_OF_CHAIN_CLUSTER_MAX
1480    if ( _set_fat_entry( last , END_OF_CHAIN_CLUSTER_MAX ) )  return 1;
1481
1482    // update the FAT on block device
1483    if ( _update_device_from_cache( _fat.fat_cache_levels,
1484                                    _fat.fat_cache_root,
1485                                    "FAT" ) )              return 1;
1486    return 0;
1487}  // end _clusters_allocate()
1488
1489
1490
1491//////////////////////////////////////////////////////////////
1492static unsigned int _clusters_release( unsigned int cluster )
1493{
1494    // scan the FAT
1495    unsigned int current = cluster;
1496    unsigned int next;
1497    do
1498    { 
1499        // get next_cluster index
1500        if ( _get_fat_entry( current , &next ) )  return 1;
1501
1502        // release current_cluster
1503        if ( _set_fat_entry( current , FREE_CLUSTER ) )   return 1;
1504
1505        // update first_free_cluster and free_clusters_number in FAT descriptor
1506        _fat.free_clusters_number = _fat.free_clusters_number + 1;
1507        if ( _fat.first_free_cluster > current ) _fat.first_free_cluster = current;
1508
1509        // update loop variable
1510        current = next;
1511    }
1512    while ( next < END_OF_CHAIN_CLUSTER_MIN );
1513
1514    // update the FAT on block device
1515    if ( _update_device_from_cache( _fat.fat_cache_levels,
1516                                    _fat.fat_cache_root,
1517                                    "FAT" ) )                return 1;
1518    return 0;
1519}  // end _clusters_release()
1520
1521
1522
1523///////////////////////////////////////////////////////////
1524static void _add_special_directories( fat_inode_t*  child, 
1525                                      fat_inode_t*  parent )
1526{
1527    // get first File-Cache buffer for child
1528    fat_cache_desc_t*   pdesc  = (fat_cache_desc_t*)child->cache->children[0];
1529    unsigned char*      entry;
1530
1531    unsigned int i;
1532    unsigned int cluster;
1533    unsigned int size;
1534
1535    // set "." entry (32 bytes)
1536    cluster = child->cluster;
1537    size    = child->size;
1538    entry   = pdesc->buffer;
1539   
1540    for ( i = 0 ; i < 32 ; i++ )
1541    {
1542        if      (i == 0 )     entry[i] = 0x2E;          // SFN
1543        else if (i <  11)     entry[i] = 0x20;          // SFN
1544        else if (i == 11)     entry[i] = 0x10;          // ATTR == dir
1545        else if (i == 20)     entry[i] = cluster>>16;   // cluster.B2
1546        else if (i == 21)     entry[i] = cluster>>24;   // cluster.B3
1547        else if (i == 26)     entry[i] = cluster>>0;    // cluster.B0
1548        else if (i == 27)     entry[i] = cluster>>8;    // cluster.B1
1549        else if (i == 28)     entry[i] = size>>0;       // size.B0
1550        else if (i == 29)     entry[i] = size>>8;       // size.B1
1551        else if (i == 30)     entry[i] = size>>16;      // size.B2
1552        else if (i == 31)     entry[i] = size>>24;      // size.B3
1553        else                  entry[i] = 0x00;
1554    }
1555
1556    // set ".." entry (32 bytes)
1557    cluster = parent->cluster;
1558    size    = parent->size;
1559    entry   = pdesc->buffer + 32;
1560
1561    for ( i = 0 ; i < 32 ; i++ )
1562    {
1563        if      (i <  2 )     entry[i] = 0x2E;          // SFN
1564        else if (i <  11)     entry[i] = 0x20;          // SFN
1565        else if (i == 11)     entry[i] = 0x10;          // ATTR == dir
1566        else if (i == 20)     entry[i] = cluster>>16;   // cluster.B2
1567        else if (i == 21)     entry[i] = cluster>>24;   // cluster.B3
1568        else if (i == 26)     entry[i] = cluster>>0;    // cluster.B0
1569        else if (i == 27)     entry[i] = cluster>>8;    // cluster.B1
1570        else if (i == 28)     entry[i] = size>>0;       // size.B0
1571        else if (i == 29)     entry[i] = size>>8;       // size.B1
1572        else if (i == 30)     entry[i] = size>>16;      // size.B2
1573        else if (i == 31)     entry[i] = size>>24;      // size.B3
1574        else                  entry[i] = 0x00;
1575    }
1576}  // end _add_special_directories
1577
1578
1579
1580////////////////////////////////////////////////////////////
1581static unsigned int _check_name_length( char* name,
1582                                        unsigned int* length,
1583                                        unsigned int* nb_lfn )
1584{
1585    unsigned int len = _strlen( name );
1586    if      ( len <= 13 )
1587    {
1588        *length  = len;
1589        *nb_lfn  = 1;
1590        return 0;
1591    }
1592    else if ( len <= 26 )
1593    {
1594        *length  = len;
1595        *nb_lfn  = 2;
1596        return 0;
1597    }
1598    else if ( len <= 31 )
1599    {
1600        *length  = len;
1601        *nb_lfn  = 3;
1602        return 0;
1603    }
1604    else
1605    {
1606        return 1;
1607    }
1608}  // _check_name_length()
1609
1610
1611
1612
1613///////////////////////////////////////////////////////////
1614static unsigned int _get_nb_entries( fat_inode_t*   inode,
1615                                     unsigned int*  nb_entries )
1616{
1617    // scan directory until "end of directory" with two embedded loops:
1618    // - scan the clusters allocated to this directory
1619    // - scan the entries to find NO_MORE_ENTRY
1620    fat_cache_desc_t*  pdesc;                      // pointer on buffer descriptor
1621    unsigned char*     buffer;                     // 4 Kbytes buffer (one cluster)
1622    unsigned int       ord;                        // ORD field in directory entry
1623    unsigned int       attr;                       // ATTR field in directory entry
1624    unsigned int       cluster_id = 0;             // cluster index in directory
1625    unsigned int       offset     = 0;             // position in scanned buffer
1626    unsigned int       found      = 0;             // NO_MORE_ENTRY found
1627    unsigned int       count      = 0;             // number of valid NORMAL entries
1628
1629    // loop on clusters allocated to directory
1630    while ( found == 0 )
1631    {
1632        // get one 4 Kytes buffer from File_Cache 
1633        if ( _get_buffer_from_cache( inode,
1634                                     cluster_id,
1635                                     &pdesc ) )   return 1;
1636
1637        buffer = pdesc->buffer;
1638       
1639        // loop on directory entries in buffer
1640        while ( (offset < 4096) && (found == 0) )
1641        {
1642            attr = _read_entry( DIR_ATTR , buffer + offset , 0 );   
1643            ord  = _read_entry( LDIR_ORD , buffer + offset , 0 );
1644
1645            if ( ord == NO_MORE_ENTRY )
1646            {
1647                found = 1;
1648            } 
1649            else if ( ord == FREE_ENTRY )             // free entry => skip
1650            {
1651                offset = offset + 32;
1652            }
1653            else if ( attr == ATTR_LONG_NAME_MASK )   // LFN entry => skip
1654            {
1655                offset = offset + 32;
1656            }
1657            else                                      // NORMAL entry
1658            {
1659                count++;
1660            }
1661
1662            offset = offset + 32;
1663
1664        }  // end loop on directory entries
1665
1666        cluster_id++;
1667        offset = 0;
1668
1669    }  // end loop on clusters
1670
1671    // return nb_entries
1672    *nb_entries = count;
1673   
1674    return 0;
1675}  // end dir_not_empty()
1676
1677
1678
1679///////////////////////////////////////////////////////////
1680static unsigned int _add_dir_entry( fat_inode_t*   child,
1681                                    fat_inode_t*   parent )
1682{
1683    // get child attributes
1684    unsigned int      is_dir  = child->is_dir;     
1685    unsigned int      size    = child->size;
1686    unsigned int      cluster = child->cluster;
1687
1688    // compute number of required entries to store child->name
1689    // - Short name (less than 13 characters) require 3 entries:
1690    //   one LFN entry / one NORMAL entry / one NO_MORE_ENTRY entry.
1691    // - Longer names (up to 31 characters) can require 4 or 5 entries:
1692    //   2 or 3 LFN entries / one NORMAL entry / one NO_MORE entry.
1693    unsigned int length;
1694    unsigned int nb_lfn;
1695    if ( _check_name_length( child->name, 
1696                             &length,
1697                             &nb_lfn ) )  return 1;
1698
1699#if (GIET_DEBUG_FAT & 1)
1700if ( _get_proctime() > GIET_DEBUG_FAT )
1701_printf("\n[DEBUG FAT] _add_dir_entry() : try to add <%s> in <%s> / nb_lfn = %d\n", 
1702        child->name , parent->name, nb_lfn );
1703#endif
1704
1705    // Find end of directory : two embedded loops:
1706    // - scan the clusters allocated to this directory
1707    // - scan the entries to find NO_MORE_ENTRY
1708    fat_cache_desc_t*  pdesc;                      // pointer on buffer descriptor
1709    unsigned char*     buffer;                     // 4 Kbytes buffer (one cluster)
1710    unsigned int       cluster_id = 0;             // cluster index in directory
1711    unsigned int       offset     = 0;             // position in scanned buffer
1712    unsigned int       found      = 0;             // NO_MORE_ENTRY found
1713
1714    // loop on clusters allocated to directory
1715    while ( found == 0 )
1716    {
1717        // get one 4 Kytes buffer from File_Cache 
1718        if ( _get_buffer_from_cache( parent,
1719                                     cluster_id,
1720                                     &pdesc ) )   return 1;
1721
1722        buffer = pdesc->buffer;
1723       
1724        // loop on directory entries in buffer
1725        while ( (offset < 4096) && (found == 0) )
1726        {
1727            if ( _read_entry( LDIR_ORD , buffer + offset , 0 ) == NO_MORE_ENTRY )
1728            {
1729                found        = 1;
1730                pdesc->dirty = 1;
1731            } 
1732            else
1733            {
1734                offset = offset + 32;
1735            }
1736        }  // end loop on entries
1737        if ( found == 0 )
1738        {
1739            cluster_id++;
1740            offset = 0;
1741        }
1742    }  // end loop on clusters
1743
1744#if (GIET_DEBUG_FAT & 1)
1745if ( _get_proctime() > GIET_DEBUG_FAT )
1746_printf("\n[DEBUG FAT] _add_dir_entry() : get NO_MORE directory entry : "
1747        " buffer = %x / offset = %x / cluster_id = %d\n",
1748        (unsigned int)buffer , offset , cluster_id );
1749#endif
1750
1751    // enter FSM :
1752    // The new child requires to write 3, 4, or 5 directory entries.
1753    // To actually register the new child, we use a 5 steps FSM
1754    // (one state per entry to be written), that is traversed as:
1755    //    LFN3 -> LFN2 -> LFN1 -> NORMAL -> NOMORE
1756    // The buffer and first directory entry to be  written are identified
1757    // by the variables : buffer / cluster_id / offset
1758
1759    unsigned char* name  = (unsigned char*)child->name;
1760
1761    unsigned int step;          // FSM state
1762
1763    if      ( nb_lfn == 1 ) step = 3;
1764    else if ( nb_lfn == 2 ) step = 4;
1765    else if ( nb_lfn == 3 ) step = 5;
1766   
1767    unsigned int   i;           // byte index in 32 bytes directory
1768    unsigned int   c;           // character index in name
1769    unsigned char* entry;       // buffer + offset;
1770
1771    while ( step )   
1772    {
1773        // get another buffer if required
1774        if ( offset >= 4096 )  // new buffer required
1775        {
1776            if ( cluster_id == 63 )   // we need to increase depth of File-Cache
1777            {
1778                _printf("\n[FAT ERROR] in add_dir_entry() File Cache depth extension "
1779                        " not implemented\n" );
1780                _exit();  // TODO   
1781            }
1782            else
1783            {
1784                if ( _get_buffer_from_cache( parent,
1785                                             cluster_id + 1,
1786                                             &pdesc ) )      return 1;       
1787                buffer       = pdesc->buffer;
1788                pdesc->dirty = 1;
1789                offset       = 0;
1790            }
1791        }
1792
1793        // compute directory entry address
1794        entry = buffer + offset;
1795
1796#if (GIET_DEBUG_FAT & 1)
1797if ( _get_proctime() > GIET_DEBUG_FAT )
1798_printf("\n[DEBUG FAT] _add_dir_entry() : FSM step = %d /"
1799        " offset = %x / nb_lfn = %d\n", step, offset, nb_lfn );
1800#endif
1801
1802        // write one 32 bytes directory entry per iteration
1803        switch ( step )
1804        {
1805            case 5:   // write LFN3 entry
1806            {
1807                c = 26;
1808                // scan the 32 bytes in dir_entry
1809                for ( i = 0 ; i < 32 ; i++ )
1810                {
1811                    if (i == 0)
1812                    {
1813                        if ( nb_lfn == 3) entry[i] = 0x43;
1814                        else              entry[i] = 0x03;
1815                    }
1816                    else if ( ( ((i >= 1 ) && (i<=10) && ((i&1)==1))   ||
1817                                ((i >= 14) && (i<=25) && ((i&1)==0))   ||
1818                                ((i >= 28) && (i<=31) && ((i&1)==0)) ) &&
1819                              ( c < length ) )
1820                    {
1821                                          entry[i] = name[c];
1822                                          c++;
1823                    }
1824                    else if (i == 11)     entry[i] = 0x0F;
1825                    else if (i == 12)     entry[i] = 0xCA;
1826                    else                  entry[i] = 0x00;
1827                }
1828                step--;
1829                break;
1830            }
1831            case 4:   // write LFN2 entry 
1832            {
1833                c = 13;
1834                // scan the 32 bytes in dir_entry
1835                for ( i = 0 ; i < 32 ; i++ )
1836                {
1837                    if (i == 0)
1838                    {
1839                        if ( nb_lfn == 2) entry[i] = 0x42;
1840                        else              entry[i] = 0x02;
1841                    }
1842                    else if ( ( ((i >= 1 ) && (i<=10) && ((i&1)==1))   ||
1843                                ((i >= 14) && (i<=25) && ((i&1)==0))   ||
1844                                ((i >= 28) && (i<=31) && ((i&1)==0)) ) &&
1845                              ( c < length ) )
1846                    {
1847                                          entry[i] = name[c];
1848                                          c++;
1849                    }
1850                    else if (i == 11)     entry[i] = 0x0F;
1851                    else if (i == 12)     entry[i] = 0xCA;
1852                    else                  entry[i] = 0x00;
1853                }
1854                step--;
1855                break;
1856            }
1857            case 3:   // Write LFN1 entry   
1858            {
1859                c = 0;
1860                // scan the 32 bytes in dir_entry
1861                for ( i = 0 ; i < 32 ; i++ )
1862                {
1863                    if (i == 0)
1864                    {
1865                        if ( nb_lfn == 1) entry[i] = 0x41;
1866                        else              entry[i] = 0x01;
1867                    }
1868                    else if ( ( ((i >= 1 ) && (i<=10) && ((i&1)==1))   ||
1869                                ((i >= 14) && (i<=25) && ((i&1)==0))   ||
1870                                ((i >= 28) && (i<=31) && ((i&1)==0)) ) &&
1871                              ( c < length ) )
1872                    {
1873                                          entry[i] = name[c];
1874                                          c++;
1875                    }
1876                    else if (i == 11)     entry[i] = 0x0F;
1877                    else if (i == 12)     entry[i] = 0xCA;
1878                    else                  entry[i] = 0x00;
1879                }
1880                step--;
1881                break;
1882            }
1883            case 2:   // write NORMAL entry     
1884            {
1885                c = 0;
1886                // scan the 32 bytes in dir_entry
1887                for ( i = 0 ; i < 32 ; i++ )
1888                {
1889                    if      ( (i < 8) && (c < length) )             // SFN
1890                    {
1891                                          entry[i] = _to_upper( name[c] );
1892                                          c++;
1893                    }
1894                    else if (i <  11)     entry[i] = 0x20;          // EXT
1895                    else if (i == 11)                               // ATTR
1896                    {
1897                        if (is_dir)       entry[i] = 0x10;
1898                        else              entry[i] = 0x20;
1899                    }
1900                    else if (i == 20)     entry[i] = cluster>>16;   // cluster.B2
1901                    else if (i == 21)     entry[i] = cluster>>24;   // cluster.B3
1902                    else if (i == 26)     entry[i] = cluster>>0;    // cluster.B0
1903                    else if (i == 27)     entry[i] = cluster>>8;    // cluster.B1
1904                    else if (i == 28)     entry[i] = size>>0;       // size.B0
1905                    else if (i == 29)     entry[i] = size>>8;       // size.B1
1906                    else if (i == 30)     entry[i] = size>>16;      // size.B2
1907                    else if (i == 31)     entry[i] = size>>24;      // size.B3
1908                    else                  entry[i] = 0x00;
1909                }
1910
1911                // update the dentry field in child inode
1912                child->dentry = ((cluster_id<<12) + offset)>>5;
1913
1914                step--;
1915                break;
1916            }
1917            case 1:   // write NOMORE entry 
1918            {
1919                step--;
1920                entry [0] = 0x00;
1921                break;
1922            }
1923        } // end switch step
1924        offset += 32;
1925    } // exit while => exit FSM   
1926
1927#if (GIET_DEBUG_FAT & 1)
1928if ( _get_proctime() > GIET_DEBUG_FAT )
1929{
1930    _printf("\n[DEBUG FAT] _add_dir_entry() : <%s> successfully added in <%s>\n",
1931            child->name , parent->name );
1932}
1933#endif
1934
1935    return 0;       
1936} // end _add_dir_entry
1937
1938
1939
1940////////////////////////////////////////////////////////////
1941static unsigned int _remove_dir_entry( fat_inode_t*  inode )
1942{
1943    // compute number of LFN entries
1944    unsigned int length;
1945    unsigned int nb_lfn;
1946    if ( _check_name_length( inode->name, 
1947                             &length,
1948                             &nb_lfn ) )  return 1;
1949
1950    // get cluster_id and offset in parent directory cache
1951    unsigned int  dentry     = inode->dentry;
1952    unsigned int  cluster_id = dentry >> 7;
1953    unsigned int  offset     = (dentry & 0x7F)<<5;
1954
1955    // get buffer from parent directory cache
1956    unsigned char*     buffer;
1957    fat_cache_desc_t*  pdesc;
1958
1959    if ( _get_buffer_from_cache( inode->parent,
1960                                 cluster_id,
1961                                 &pdesc ) ) return 1;
1962    buffer       = pdesc->buffer;
1963    pdesc->dirty = 1;
1964
1965    // invalidate NORMAL entry in directory cache
1966    buffer[offset] = 0xE5;
1967
1968    // invalidate LFN entries
1969    while ( nb_lfn )
1970    {
1971        if (offset == 0)  // we must load buffer for (cluster_id - 1)
1972        {
1973            if ( _get_buffer_from_cache( inode->parent,
1974                                         cluster_id - 1,
1975                                         &pdesc ) )   return 1;
1976            buffer       = pdesc->buffer;
1977            pdesc->dirty = 1;
1978            offset       = 4096;
1979        }
1980
1981        offset = offset - 32;
1982
1983        // check for LFN entry
1984        if ( _read_entry( DIR_ATTR , buffer + offset , 0 ) != ATTR_LONG_NAME_MASK )
1985            break;
1986
1987        // invalidate LFN entry
1988        buffer[offset] = 0xE5;
1989
1990        nb_lfn--;
1991    }     
1992         
1993    return 0;
1994}  // end _remove_dir_entry
1995
1996
1997
1998
1999////////////////////////////////////////////////////////////
2000static unsigned int _update_dir_entry( fat_inode_t*  inode )
2001{ 
2002    // get Cache-File buffer containing the parent directory entry
2003    // 128 directories entries in one 4 Kbytes buffer
2004    fat_cache_desc_t*  pdesc;
2005    unsigned char*     buffer;   
2006    unsigned int       cluster_id = inode->dentry>>7;
2007    unsigned int       offset     = (inode->dentry & 0x3F)<<5;
2008
2009    if ( _get_buffer_from_cache( inode->parent,
2010                                 cluster_id,
2011                                 &pdesc ) )    return 1;
2012    buffer       = pdesc->buffer;
2013    pdesc->dirty = 1;
2014
2015    // update size field
2016    buffer[offset + 28] = inode->size>>0;       // size.B0
2017    buffer[offset + 29] = inode->size>>8;       // size.B1
2018    buffer[offset + 30] = inode->size>>16;      // size.B2
2019    buffer[offset + 31] = inode->size>>24;      // size.B3
2020
2021    // update cluster field
2022    buffer[offset + 26] = inode->cluster>>0;    // cluster.B0
2023    buffer[offset + 27] = inode->cluster>>8;    // cluster.B1
2024    buffer[offset + 20] = inode->cluster>>16;   // cluster.B2
2025    buffer[offset + 21] = inode->cluster>>24;   // cluster.B3
2026   
2027    return 0;
2028} // end _update_dir_entry()
2029
2030
2031
2032
2033//////////////////////////////////////////////////////////////////
2034static unsigned int _get_child_from_parent( fat_inode_t*   parent,
2035                                            char*          name, 
2036                                            fat_inode_t**  inode )
2037{
2038    fat_inode_t*   current;
2039
2040#if (GIET_DEBUG_FAT & 1)
2041if ( _get_proctime() > GIET_DEBUG_FAT )
2042_printf("\n[DEBUG FAT] _get_child_from_parent() : search <%s> in directory <%s>\n",
2043        name , parent->name );
2044#endif
2045   
2046    // scan inodes in the parent directory
2047    for ( current = parent->child ; current ; current = current->next )
2048    {
2049        if ( _strcmp( name , current->name ) == 0 )
2050        {
2051
2052#if (GIET_DEBUG_FAT & 1)
2053if ( _get_proctime() > GIET_DEBUG_FAT )
2054_printf("\n[DEBUG FAT] _get_child_from_parent() : found inode <%s> in directory <%s>\n", 
2055        name , parent->name );
2056#endif
2057            *inode = current;
2058            return 0;           // name found
2059        }
2060    }
2061
2062    // not found in Inode-Tree => access the parent directory
2063    // file_cache.  Two embedded loops:
2064    // - scan the clusters allocated to this directory
2065    // - scan the directory entries in each 4 Kbytes buffer
2066
2067    unsigned char*    buffer;           // pointer on one cache buffer
2068    char              cname[32];        // buffer for one full entry name
2069    char              lfn1[16];         // buffer for one partial name
2070    char              lfn2[16];         // buffer for one partial name
2071    char              lfn3[16];         // buffer for one partial name
2072    unsigned int      size;             // searched file/dir size (bytes)
2073    unsigned int      cluster;          // searched file/dir cluster index
2074    unsigned int      is_dir;           // searched file/dir type
2075    unsigned int      attr;             // directory entry ATTR field
2076    unsigned int      ord;              // directory entry ORD field
2077    unsigned int      lfn = 0;          // LFN entries number
2078    unsigned int      dentry;           // directory entry index
2079    unsigned int      offset     = 0;   // byte offset in buffer
2080    unsigned int      cluster_id = 0;   // cluster index in directory
2081    int               found      = 0;   // not found (0) / name found (1) / end of dir (-1)
2082
2083#if (GIET_DEBUG_FAT & 1)
2084if ( _get_proctime() > GIET_DEBUG_FAT )
2085_printf("\n[DEBUG FAT] _get_child_from_parent() : does not found inode <%s>"
2086        " in directory <%s> => search in cache\n", name , parent->name );
2087#endif
2088
2089    // scan the clusters allocated to parent directory
2090    while ( found == 0 )
2091    {
2092        // get one 4 Kytes buffer from parent File_Cache 
2093        fat_cache_desc_t*  pdesc;
2094        if ( _get_buffer_from_cache( parent,
2095                                     cluster_id,
2096                                     &pdesc ) )    return 2;
2097        buffer = pdesc->buffer;
2098
2099        // scan this buffer until end of directory, end of buffer, or name found
2100        while( (offset < 4096) && (found == 0) )
2101        {
2102
2103#if (GIET_DEBUG_FAT & 1)
2104if ( _get_proctime() > GIET_DEBUG_FAT )
2105_printf("\n[DEBUG FAT] _get_child_from_parent() : scan buffer %d for <%s>\n",
2106        cluster_id , name );
2107#endif
2108            attr = _read_entry( DIR_ATTR , buffer + offset , 0 );   
2109            ord  = _read_entry( LDIR_ORD , buffer + offset , 0 );
2110
2111            if (ord == NO_MORE_ENTRY)                 // no more entry in directory => break
2112            {
2113                found = -1;
2114            }
2115            else if ( ord == FREE_ENTRY )             // free entry => skip
2116            {
2117                offset = offset + 32;
2118            }
2119            else if ( attr == ATTR_LONG_NAME_MASK )   // LFN entry => get partial name
2120            {
2121                unsigned int seq = ord & 0x3;
2122                lfn = (seq > lfn) ? seq : lfn;   
2123                if      ( seq == 1 ) _get_name_from_long( buffer + offset, lfn1 );
2124                else if ( seq == 2 ) _get_name_from_long( buffer + offset, lfn2 );
2125                else if ( seq == 3 ) _get_name_from_long( buffer + offset, lfn3 );
2126                offset = offset + 32;
2127            }
2128            else                                 // NORMAL entry
2129            {
2130                // build the extracted name
2131                if      ( lfn == 0 )
2132                {
2133                    _get_name_from_short( buffer + offset , cname );
2134                }
2135                else if ( lfn == 1 )
2136                {
2137                    _strcpy( cname      , lfn1 );
2138                }   
2139                else if ( lfn == 2 ) 
2140                {
2141                    _strcpy( cname      , lfn1 );
2142                    _strcpy( cname + 13 , lfn2 );
2143                }
2144                else if ( lfn == 3 ) 
2145                {
2146                    _strcpy( cname      , lfn1 );
2147                    _strcpy( cname + 13 , lfn2 );
2148                    _strcpy( cname + 26 , lfn3 );
2149                }
2150                   
2151                // test if extracted name == searched name
2152                if ( _strcmp( name , cname ) == 0 )
2153                {
2154                    cluster = (_read_entry( DIR_FST_CLUS_HI , buffer + offset , 1 ) << 16) |
2155                              (_read_entry( DIR_FST_CLUS_LO , buffer + offset , 1 )      ) ;
2156                    dentry  = ((cluster_id<<12) + offset)>>5;
2157                    is_dir  = ((attr & ATTR_DIRECTORY) == ATTR_DIRECTORY);
2158                    size    = _read_entry( DIR_FILE_SIZE , buffer + offset , 1 );
2159                    found   = 1;
2160                }
2161                offset = offset + 32;
2162                lfn    = 0;
2163            }
2164        }  // end loop on directory entries
2165        cluster_id++;
2166        offset = 0;
2167    }  // end loop on buffers
2168
2169    if ( found == -1 )  // found end of directory in parent directory
2170    {
2171
2172#if (GIET_DEBUG_FAT & 1)
2173if ( _get_proctime() > GIET_DEBUG_FAT )
2174_printf("\n[DEBUG FAT] _get_child_from_parent() : found end of directory in <%s>\n",
2175        parent->name );
2176#endif
2177        *inode = NULL;
2178        return 1;
2179    }
2180    else               // found searched name in parent directory
2181    {
2182        // allocate a new inode and an empty Cache-File
2183        *inode = _allocate_one_inode( name,
2184                                      is_dir,
2185                                      cluster,
2186                                      size,
2187                                      0,             // count
2188                                      dentry,
2189                                      1 );           // cache_allocate
2190
2191        // introduce it in Inode-Tree
2192        _add_inode_in_tree( *inode , parent );
2193
2194#if (GIET_DEBUG_FAT & 1)
2195if ( _get_proctime() > GIET_DEBUG_FAT )
2196_printf("\n[DEBUG FAT] _get_child_from_parent() : found <%s> on device\n", name );
2197#endif
2198        return 0;
2199    }
2200}  // end _get_child_from_parent()
2201
2202
2203
2204
2205//////////////////////////////////////////////////////////////////
2206static unsigned int _get_inode_from_path( char*          pathname,
2207                                          fat_inode_t**  inode )
2208{
2209    char                 name[32];         // buffer for one name in pathname
2210    unsigned int         nb_read;              // number of characters written in name[]
2211    fat_inode_t*         parent;           // parent inode
2212    fat_inode_t*         child;            // child inode
2213    unsigned int         last;             // while exit condition
2214    unsigned int         code;             // return value
2215
2216#if (GIET_DEBUG_FAT & 1)
2217if ( _get_proctime() > GIET_DEBUG_FAT )
2218_printf("\n[DEBUG FAT] _get_inode_from_path() : enters for path <%s>\n", pathname );
2219#endif
2220
2221    // handle root directory case
2222    if ( _strcmp( pathname , "/" ) == 0 )
2223    {
2224
2225#if (GIET_DEBUG_FAT & 1)
2226if ( _get_proctime() > GIET_DEBUG_FAT )
2227_printf("\n[DEBUG FAT] _get_inode_from_path() : found root inode for <%s>\n", 
2228        pathname );
2229#endif
2230        *inode  = _fat.inode_tree_root;
2231        return 0;
2232    }
2233
2234    // If the pathname is not "/", we traverse the inode tree from the root.
2235    // We use _get_name_from_path() to scan pathname and extract inode names.
2236    // We use _get_child_from_parent() to scan each directory in the path.
2237
2238    last       = 0;
2239    nb_read    = 0;                      // number of characters analysed in path
2240    parent     = _fat.inode_tree_root;   // Inode-Tree root
2241   
2242    while ( !last )
2243    {
2244        // get searched file/dir name
2245        if ( _get_name_from_path( pathname, name, &nb_read ) )
2246        {
2247            return 3;   // error : name too long
2248        }
2249
2250        // compute last iteration condition
2251        last = (pathname[nb_read] == 0);
2252
2253#if (GIET_DEBUG_FAT & 1)
2254if ( _get_proctime() > GIET_DEBUG_FAT )
2255_printf("\n[DEBUG FAT] _get_inode_from_path() : got name <%s>\n", name );
2256#endif
2257
2258        if ( _strcmp( name, ".." ) == 0)
2259        {
2260            // found special name "..", try to go up
2261            code = 0;
2262            if ( parent->parent )
2263                child = parent->parent;
2264            else
2265                child = parent;
2266        }
2267        else if ( _strcmp( name, "." ) == 0 )
2268        {
2269            // found special name ".", stay on the same level
2270            code = 0;
2271            child = parent;
2272        }
2273        else
2274        {
2275            // get child inode from parent directory
2276            code = _get_child_from_parent( parent,
2277                                           name,
2278                                           &child );
2279
2280            // we need to find the child inode for all non terminal names
2281            if ( (code == 2) || ((code == 1 ) && !last) )
2282            {
2283
2284    #if (GIET_DEBUG_FAT & 1)
2285    if ( _get_proctime() > GIET_DEBUG_FAT )
2286    _printf("\n[DEBUG FAT] _get_inode_from_path() : neither parent, nor child found for <%s>\n",
2287            pathname );
2288    #endif
2289                return 2;  // error : parent inode not found
2290            }
2291        }
2292
2293        // update parent if not the last iteration
2294        if ( !last )
2295            parent = child;
2296    } // end while
2297
2298    // returns inode pointer
2299    if (code == 0 )
2300    {
2301
2302#if (GIET_DEBUG_FAT & 1)
2303if ( _get_proctime() > GIET_DEBUG_FAT )
2304_printf("\n[DEBUG FAT] _get_inode_from_path() : found inode for <%s>\n", 
2305        pathname );
2306#endif
2307        *inode  = child;
2308    }
2309    else
2310    {
2311
2312#if (GIET_DEBUG_FAT & 1)
2313if ( _get_proctime() > GIET_DEBUG_FAT )
2314_printf("\n[DEBUG FAT] _get_inode_from_path() : found only parent inode for <%s>\n",
2315        pathname );
2316#endif
2317        *inode  = parent;
2318    }
2319
2320    return code;                 // can be 0 (found) or 1 (not found)
2321
2322}  // end _get_inode_from_path()
2323
2324
2325
2326
2327//////////////////////////////////////////////////////////////
2328static unsigned int _remove_node_from_fs( fat_inode_t* inode )
2329{
2330    // remove entry in parent directory
2331    if ( _remove_dir_entry( inode ) ) return 1;
2332
2333    // update parent directory on device
2334    if ( _update_device_from_cache( inode->parent->levels,
2335                                    inode->parent->cache,
2336                                    inode->parent->name ) ) return 1;
2337
2338    // release clusters allocated to file/dir in DATA region
2339    if ( _clusters_release( inode->cluster ) ) return 1;
2340
2341    // release File-Cache
2342    if ( _release_cache_memory( inode->cache,
2343                                inode->levels ) ) return 1;
2344
2345    // remove inode from Inode-Tree
2346    _remove_inode_from_tree( inode );
2347
2348    // release inode
2349    _free ( inode );
2350
2351    return 0;
2352}  // end _remove_node_from_fs()
2353
2354
2355//////////////////////////////////////////////////////////////////
2356static unsigned int _next_cluster_no_cache( unsigned int   cluster,
2357                                            unsigned int*  next )
2358{
2359    // compute cluster_id and slot_id
2360    // each cluster contains 1024 slots (4 bytes per slot)
2361    unsigned int cluster_id  = cluster >> 10;
2362    unsigned int slot_id     = cluster & 0x3FF;
2363
2364    // compute lba of cluster identified by cluster_id
2365    unsigned int lba = _fat.fat_lba + (cluster_id << 3);
2366
2367    // get cluster containing the adressed FAT slot in FAT buffer
2368    if ( _fat_buffer_fat_lba != lba )
2369    {
2370        if ( _fat_ioc_access( 0,         // no descheduling
2371                              1,         // read
2372                              lba,
2373                              (unsigned int)_fat_buffer_fat,
2374                              8 ) )
2375        {
2376            _printf("\n[FAT ERROR] in _next_cluster_no_cache() : "
2377                    "cannot load lba = %x into fat_buffer\n", lba );
2378            return 1;
2379        }
2380
2381        _fat_buffer_fat_lba = lba;
2382    }
2383
2384    // return next cluster index
2385    unsigned int* buf = (unsigned int*)_fat_buffer_fat;
2386    *next = buf[slot_id];
2387    return 0;
2388   
2389}  // end _next_cluster_no_cache()
2390
2391
2392
2393
2394/////////////////////////////////////////////////////////////////
2395static unsigned int _file_info_no_cache( char*          pathname,
2396                                         unsigned int*  file_cluster,
2397                                         unsigned int*  file_size )
2398{
2399   
2400#if (GIET_DEBUG_FAT & 1)
2401if ( _get_proctime() > GIET_DEBUG_FAT )
2402_printf("\n[DEBUG FAT] _file_info_no_cache() : enters for path <%s>\n", pathname );
2403#endif
2404
2405    char            name[32];             // buffer for one name in the analysed pathname
2406    char            lfn1[16];             // buffer for a partial name in LFN entry
2407    char            lfn2[16];             // buffer for a partial name in LFN entry
2408    char            lfn3[16];             // buffer for a partial name in LFN entry
2409    char            cname[32];            // buffer for a full name in a directory entry
2410    unsigned int    nb_read;              // number of characters analysed in path
2411    unsigned int    parent_cluster;       // cluster index for the parent directory
2412    unsigned int    child_cluster = 0;    // cluster index for the searched file/dir
2413    unsigned int    child_size = 0;       // size of the searched file/dir
2414    unsigned int    child_is_dir;         // type of the searched file/dir
2415    unsigned int    offset;               // offset in a 4 Kbytes buffer
2416    unsigned int    ord;                  // ORD field in a directory entry
2417    unsigned int    attr;                 // ATTR field in a directory entry
2418    unsigned int    lfn = 0;              // number of lfn entries
2419    unsigned char*  buf;                  // pointer on a 4 Kbytes buffer
2420    unsigned int    found;                // name found in current directory entry
2421
2422    // Three embedded loops:
2423    // - scan pathname to extract file/dir names,
2424    // - for each name, scan the clusters of the parent directory
2425    // - for each cluster, scan the 4 Kbytes buffer to find the file/dir name
2426    // The starting point is the root directory (cluster 2)
2427
2428    nb_read        = 0;
2429    parent_cluster = 2; 
2430
2431    // scan pathname 
2432    while ( pathname[nb_read] != 0 )   
2433    {
2434        // get searched file/dir name
2435        if ( _get_name_from_path( pathname, name, &nb_read ) ) return 1;
2436
2437#if (GIET_DEBUG_FAT & 1)
2438if ( _get_proctime() > GIET_DEBUG_FAT )
2439_printf("\n[DEBUG FAT] _file_info_no_cache() : search name <%s>"
2440        " in cluster %x\n", name , parent_cluster );
2441#endif
2442        found  = 0;
2443
2444        // scan clusters containing the parent directory
2445        while ( found == 0 ) 
2446        {
2447            // compute lba
2448            unsigned int lba = _cluster_to_lba( parent_cluster );
2449
2450            // load one cluster of the parent directory into data_buffer
2451            if ( _fat_buffer_data_lba != lba )
2452            {
2453                if ( _fat_ioc_access( 0,         // no descheduling
2454                                      1,         // read
2455                                      lba,
2456                                      (unsigned int)_fat_buffer_data,
2457                                      8 ) )
2458                {
2459                    _printf("\n[FAT ERROR] in _file_info_no_cache() : "
2460                            "cannot load lba = %x into data_buffer\n", lba );
2461                    return 1;
2462                }
2463
2464                _fat_buffer_data_lba = lba;
2465            }
2466
2467            offset = 0;
2468
2469            // scan this 4 Kbytes buffer
2470            while ( (offset < 4096) && (found == 0) )
2471            {
2472                buf  = _fat_buffer_data + offset;
2473                attr = _read_entry( DIR_ATTR , buf , 0 );   
2474                ord  = _read_entry( LDIR_ORD , buf , 0 );
2475
2476                if (ord == NO_MORE_ENTRY)               // no more entry => break
2477                {
2478                    found = 2;
2479                }
2480                else if ( ord == FREE_ENTRY )           // free entry => skip
2481                {
2482                    offset = offset + 32;
2483                }
2484                else if ( attr == ATTR_LONG_NAME_MASK ) // LFN entry => get partial name
2485                {
2486                    unsigned int seq = ord & 0x3;
2487                    lfn = (seq > lfn) ? seq : lfn;   
2488                    if      ( seq == 1 ) _get_name_from_long( buf, lfn1 );
2489                    else if ( seq == 2 ) _get_name_from_long( buf, lfn2 );
2490                    else if ( seq == 3 ) _get_name_from_long( buf, lfn3 );
2491                    offset = offset + 32;
2492                }
2493                else                                    // NORMAL entry
2494                {
2495                    // build the full mame for current directory entry
2496                    if      ( lfn == 0 )
2497                    {
2498                        _get_name_from_short( buf , cname );
2499                    }
2500                    else if ( lfn == 1 )
2501                    {
2502                        _strcpy( cname      , lfn1 );
2503                    }   
2504                    else if ( lfn == 2 ) 
2505                    {
2506                        _strcpy( cname      , lfn1 );
2507                        _strcpy( cname + 13 , lfn2 );
2508                    }
2509                    else if ( lfn == 3 ) 
2510                    {
2511                        _strcpy( cname      , lfn1 );
2512                        _strcpy( cname + 13 , lfn2 );
2513                        _strcpy( cname + 26 , lfn3 );
2514                    }
2515                   
2516                    // test if extracted name == searched name
2517                    if ( _strcmp( name , cname ) == 0 )
2518                    {
2519                        child_cluster = (_read_entry( DIR_FST_CLUS_HI , buf , 1 ) << 16) |
2520                                        (_read_entry( DIR_FST_CLUS_LO , buf , 1 )      ) ;
2521                        child_is_dir  = ((attr & ATTR_DIRECTORY) == ATTR_DIRECTORY);
2522                        child_size    = _read_entry( DIR_FILE_SIZE , buf , 1 );
2523                        found         = 1;
2524                    }
2525                    offset = offset + 32;
2526                    lfn = 0;
2527                }
2528            }  // en loop on directory entries
2529           
2530            // compute next cluster index
2531            unsigned int next;
2532            if ( _next_cluster_no_cache ( parent_cluster , &next ) ) return 1;
2533            parent_cluster = next;
2534        } // end loop on clusters
2535
2536        if ( found == 2 )  // found end of directory => error
2537        { 
2538            _printf("\n[FAT ERROR] in _file_info_no_cache() : <%s> not found\n",
2539                    name );
2540            return 1;
2541        }
2542 
2543        // check type
2544        if ( ((pathname[nb_read] == 0) && (child_is_dir != 0)) ||
2545             ((pathname[nb_read] != 0) && (child_is_dir == 0)) )
2546        {
2547            _printf("\n[FAT ERROR] in _file_info_no_cache() : illegal type for <%s>\n", name );
2548            return 1;
2549        }
2550
2551        // update parent_cluster for next name
2552        parent_cluster = child_cluster;
2553
2554    }  // end loop on names
2555
2556#if (GIET_DEBUG_FAT & 1)
2557if ( _get_proctime() > GIET_DEBUG_FAT )
2558_printf("\n[DEBUG FAT] _file_info_no_cache() : success for <%s> / "
2559        "file_size = %x / file_cluster = %x\n", pathname, child_size, child_cluster );
2560#endif
2561
2562    // return file cluster and size
2563    *file_size    = child_size;
2564    *file_cluster = child_cluster;
2565    return 0;
2566
2567}  // end _file_info_no_cache()
2568
2569
2570
2571/////////////////////////////////////////////////////////////////////////////
2572/////////////////////////////////////////////////////////////////////////////
2573//             Extern functions                                               
2574/////////////////////////////////////////////////////////////////////////////
2575/////////////////////////////////////////////////////////////////////////////
2576
2577
2578/////////////////////////////////////////////////////////////////////////////
2579// This function initializes the FAT structures.
2580// - The Fat-Descriptor is always initialised.
2581// - The dynamically allocated structures (the Inode-Tre, the Fat_Cache,
2582//   and the File-Cache for the root directory) are only allocated
2583//   and initialised if the "kernel_mode" argument is set.
2584/////////////////////////////////////////////////////////////////////////////
2585// Implementation note:
2586// This function is called twice, by the boot-loader, and by the kernel_init.
2587// It does not use dynamic memory allocation from the distributed heap.
2588// It use informations found in the boot sector and FS-INFO sector.
2589// that are loaded in the Fat-Descriptor temporary block_buffer.
2590/////////////////////////////////////////////////////////////////////////////
2591// Returns 0 if success.
2592// Returns -1 if error.
2593/////////////////////////////////////////////////////////////////////////////
2594int _fat_init( unsigned int kernel_mode ) 
2595{
2596
2597#if GIET_DEBUG_FAT
2598if ( _get_proctime() > GIET_DEBUG_FAT )
2599_printf("\n[DEBUG FAT] _fat_init() : enters at cycle %d\n", _get_proctime() );
2600#endif
2601
2602    // FAT initialisation should be done only once
2603    if ( _fat.initialised == FAT_INITIALISED )
2604    {
2605        _printf("\n[FAT ERROR] in _fat_init() : FAT already initialised\n");
2606        return -1;
2607    }
2608
2609    // load Boot sector (VBR) into FAT buffer
2610    if ( _fat_ioc_access( 0,                                  // no descheduling
2611                          1,                                  // read
2612                          0,                                  // block index
2613                          (unsigned int)_fat.block_buffer,
2614                          1 ) )                               // one block
2615    {
2616        _printf("\n[FAT ERROR] in _fat_init() cannot load VBR\n");
2617        return -1;
2618    }
2619
2620    _fat.block_buffer_lba = 0;
2621   
2622#if GIET_DEBUG_FAT
2623if ( _get_proctime() > GIET_DEBUG_FAT )
2624{
2625    _printf("\n[DEBUG FAT] _fat_init() : Boot sector loaded\n");
2626    _display_one_block( _fat.block_buffer, "block device", _fat.block_buffer_lba );
2627}
2628#endif
2629
2630    // checking various FAT32 assuptions from boot sector
2631    if( _read_entry( BPB_BYTSPERSEC, _fat.block_buffer, 1 ) != 512 )
2632    {
2633        _printf("\n[FAT ERROR] The sector size must be 512 bytes\n");
2634        return -1;
2635    }
2636    if( _read_entry( BPB_SECPERCLUS, _fat.block_buffer, 1 ) != 8 )
2637    {
2638        _printf("\n[FAT ERROR] The cluster size must be 8 blocks\n");
2639        return -1;
2640    }
2641    if( _read_entry( BPB_NUMFATS, _fat.block_buffer, 1 ) != 1 )
2642    {
2643        _printf("\n[FAT ERROR] The number of FAT copies in FAT region must be 1\n");
2644        return -1;
2645    }
2646    if( (_read_entry( BPB_FAT32_FATSZ32, _fat.block_buffer, 1 ) & 0xF) != 0 )
2647    {
2648        _printf("\n[FAT ERROR] The FAT region must be multiple of 16 sectors\n");
2649        return -1;
2650    }
2651    if( _read_entry( BPB_FAT32_ROOTCLUS, _fat.block_buffer, 1 ) != 2 )
2652    {
2653        _printf("\n[FAT ERROR] The root directory must be at cluster 2\n");
2654        return -1;
2655    }
2656
2657    // initialise Fat-Descriptor from VBR
2658    _fat.sector_size         = 512;
2659    _fat.cluster_size        = 4096;
2660    _fat.fat_sectors         = _read_entry( BPB_FAT32_FATSZ32 , _fat.block_buffer , 1 );
2661    _fat.fat_lba             = _read_entry( BPB_RSVDSECCNT , _fat.block_buffer , 1 );
2662    _fat.data_sectors        = _fat.fat_sectors << 10;
2663    _fat.data_lba            = _fat.fat_lba + _fat.fat_sectors;
2664    _fat.fs_info_lba         = _read_entry( BPB_FAT32_FSINFO , _fat.block_buffer , 1 );
2665    _fat_buffer_fat_lba      = 0xFFFFFFFF;
2666    _fat_buffer_data_lba     = 0xFFFFFFFF;
2667    _fat.initialised         = FAT_INITIALISED;
2668
2669    // load FS_INFO sector into FAT buffer
2670    if ( _fat_ioc_access( 0,                                // no descheduling
2671                          1,                                // read
2672                          _fat.fs_info_lba,                 // lba
2673                          (unsigned int)_fat.block_buffer,
2674                          1 ) )                             // one block
2675    { 
2676        _printf("\n[FAT ERROR] in _fat_init() cannot load FS_INFO Sector\n"); 
2677        return -1;
2678    }
2679
2680    _fat.block_buffer_lba = _fat.fs_info_lba;
2681
2682#if GIET_DEBUG_FAT
2683if ( _get_proctime() > GIET_DEBUG_FAT )
2684{
2685    _printf("\n[DEBUG FAT] _fat_init() : FS-INFO sector loaded\n");
2686    _display_one_block( _fat.block_buffer, "block device", _fat.block_buffer_lba );
2687}
2688#endif
2689
2690    // initialise Fat-Descriptor from FS_INFO
2691    _fat.free_clusters_number   = _read_entry( FS_FREE_CLUSTERS    , _fat.block_buffer, 1);
2692    _fat.first_free_cluster     = _read_entry( FS_FREE_CLUSTER_HINT, _fat.block_buffer, 1);
2693
2694    // This is done only when the _fat_init() is called in kernel mode
2695
2696    if ( kernel_mode )
2697    {
2698        unsigned int   n;
2699
2700        // allocate and initialise the Inode-Tree root
2701        fat_inode_t*      inode  = _malloc( sizeof(fat_inode_t) );
2702        fat_cache_node_t* cache  = _malloc( sizeof(fat_cache_node_t) );
2703
2704        inode->parent   = NULL;        // no parent
2705        inode->next     = NULL;        // no brother
2706        inode->child    = NULL;        // children come later
2707        inode->cache    = cache;       // empty cache
2708        inode->cluster  = 2;           // forced value
2709        inode->size     = 0;           // no size for a directory
2710        inode->count    = 0;           // children come later
2711        inode->dentry   = 0;           // no parent => no dentry
2712        inode->levels   = 1;           // one level cache
2713        inode->is_dir   = 1;           // it's a directory
2714        _strcpy( inode->name , "/" ); 
2715
2716        for ( n = 0 ; n < 64 ; n ++ )  cache->children[n] = NULL;
2717
2718        _fat.inode_tree_root = inode;
2719
2720        // initialise the lock
2721        _spin_lock_init( &_fat.fat_lock );
2722
2723        // initialise File Descriptor Array
2724        for( n = 0 ; n < GIET_OPEN_FILES_MAX ; n++ ) _fat.fd[n].allocated = 0;
2725
2726        // initialise fat_cache root
2727        fat_cache_node_t*  fat_cache_root = _malloc( sizeof(fat_cache_node_t) );
2728        _fat.fat_cache_root   = fat_cache_root;
2729        _fat.fat_cache_levels = _get_levels_from_size( _fat.fat_sectors << 9 );
2730        for ( n = 0 ; n < 64 ; n++ ) _fat.fat_cache_root->children[n] = NULL;
2731
2732    }  // end if kernel_mode
2733
2734#if GIET_DEBUG_FAT
2735if ( _get_proctime() > GIET_DEBUG_FAT )
2736_display_fat_descriptor();
2737#endif
2738
2739    return 0;
2740}  // end _fat_init()
2741
2742
2743
2744
2745///////////////////////////////////////////////////////////////////////////////
2746// This function implements the giet_fat_open() system call.
2747// The semantic is similar to the UNIX open() function, but only the O_CREATE
2748// and O_RDONLY flags are supported. The UNIX access rights are not supported.
2749// If the file does not exist in the specified directory, it is created.
2750// If the specified directory does not exist, an error is returned.
2751// It allocates a file descriptor to the calling task, for the file identified
2752// by "pathname". If several tasks try to open the same file, each task 
2753// obtains a private file descriptor.
2754// A node name (file or directory) cannot be larger than 31 characters.
2755///////////////////////////////////////////////////////////////////////////////
2756// Returns file descriptor index if success
2757// Returns a negative value if error:
2758//   -1  :  "fat not initialised"
2759//   -2  :  "path to parent not found"
2760//   -3  :  "one name in path too long"
2761//   -4  :  "file not found"
2762//   -5  :  "Cannot update parent directory"
2763//   -6  :  "Cannot update DATA region"
2764//   -7  :  "Cannot update FAT region"
2765//   -8  :  "Cannot update FS_INFO sector"
2766//   -9  :  "file descriptor array full"
2767///////////////////////////////////////////////////////////////////////////////
2768int _fat_open( char*        pathname,     // absolute path from root
2769               unsigned int flags )       // O_CREATE and O_RDONLY
2770{
2771    unsigned int         fd_id;            // index in File-Descriptor-Array
2772    unsigned int         code;             // error code
2773    fat_inode_t*         inode;            // anonymous inode pointer
2774    fat_inode_t*         child;            // pointer on searched file inode
2775    fat_inode_t*         parent;           // pointer on parent directory inode
2776   
2777    // get flags
2778    unsigned int create    = ((flags & O_CREATE) != 0);
2779    unsigned int read_only = ((flags & O_RDONLY) != 0); 
2780
2781#if GIET_DEBUG_FAT
2782unsigned int procid  = _get_procid();
2783unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
2784unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
2785unsigned int p       = procid & ((1<<P_WIDTH)-1);
2786if ( _get_proctime() > GIET_DEBUG_FAT )
2787_printf("\n[DEBUG FAT] _fat_open() : P[%d,%d,%d] enters for path <%s> / "
2788        " create = %d / read_only = %d\n",
2789        x, y, p, pathname , create , read_only );
2790#endif
2791
2792    // checking FAT initialised
2793    if( _fat.initialised != FAT_INITIALISED )
2794    {
2795        _printf("\n[FAT ERROR] in _fat_open() : FAT not initialised\n");
2796        return -1;
2797    }
2798
2799    // takes the lock
2800    _spin_lock_acquire( &_fat.fat_lock );
2801
2802    // get inode pointer
2803    code = _get_inode_from_path( pathname , &inode );
2804
2805    if ( code == 2 ) 
2806    {
2807        _spin_lock_release( &_fat.fat_lock );
2808        _printf("\n[FAT ERROR] in _fat_open() : path to parent not found"
2809                " for file <%s>\n", pathname );
2810        return -2;
2811    }
2812    else if ( code == 3 ) 
2813    {
2814        _spin_lock_release( &_fat.fat_lock );
2815        _printf("\n[FAT ERROR] in _fat_open() : one name in path too long"
2816                " for file <%s>\n", pathname );
2817        return -3;
2818    }
2819    else if ( (code == 1) && (create == 0) )   
2820    {
2821        _spin_lock_release( &_fat.fat_lock );
2822        _printf("\n[FAT ERROR] in _fat_open() : file not found"
2823                " for file <%s>\n", pathname );
2824        return -4;
2825    }
2826    else if ( (code == 1) && (create != 0) )   // file name not found => create
2827    {
2828        // set parent inode pointer
2829        parent = inode;
2830
2831#if GIET_DEBUG_FAT
2832if ( _get_proctime() > GIET_DEBUG_FAT )
2833_printf("\n[DEBUG FAT] _fat_open() : P[%d,%d,%d] create a new file <%s>\n",
2834        x , y , p , pathname );
2835#endif
2836
2837        // get new file name / error check already done by _get_inode_from_path()
2838        char name[32];       
2839        _get_last_name( pathname , name );
2840
2841        // allocate a new inode and an empty Cache-File
2842        child = _allocate_one_inode( name,
2843                                     0,                         // not a directory
2844                                     END_OF_CHAIN_CLUSTER_MAX,  // no cluster allocated
2845                                     0,                         // size : new file is empty
2846                                     0,                         // count incremented later
2847                                     0,                         // dentry set by add_dir_entry
2848                                     1 );                       // cache_allocate
2849
2850        // introduce inode into Inode-Tree
2851        _add_inode_in_tree( child , parent );
2852
2853        // add an entry in the parent directory Cache_file
2854        if ( _add_dir_entry( child , parent ) )
2855        {
2856            _spin_lock_release( &_fat.fat_lock );
2857            _printf("\n[FAT ERROR] in _fat_open() : cannot update parent directory"
2858                    " for file <%s>\n" , pathname );
2859            return -5;
2860        } 
2861
2862        // update DATA region on block device for parent directory
2863        if ( _update_device_from_cache( parent->levels,
2864                                        parent->cache,
2865                                        parent->name ) )
2866        {
2867            _spin_lock_release( &_fat.fat_lock );
2868            _printf("\n[FAT ERROR] in _fat_open() : cannot update DATA region "
2869                    " for parent of file <%s>\n", pathname );
2870            return -6;
2871        }
2872
2873        // update FAT region on block device
2874        if ( _update_device_from_cache( _fat.fat_cache_levels,
2875                                        _fat.fat_cache_root,
2876                                        "FAT" ) )
2877        {
2878            _spin_lock_release( &_fat.fat_lock );
2879            _printf("\n[FAT ERROR] in _fat_open() : cannot update FAT region"
2880                    " for file <%s>\n", pathname );
2881            return -7;
2882        }
2883
2884        // update FS_INFO sector
2885        if ( _update_fs_info() )
2886        {
2887            _spin_lock_release( &_fat.fat_lock );
2888            _printf("\n[FAT ERROR] in _fat_open() : cannot update FS-INFO"
2889                    " for file <%s>\n", pathname );
2890            return -8;
2891        }
2892    }
2893    else // code == 0
2894    {
2895        // set searched file inode pointer
2896        child = inode;
2897
2898#if GIET_DEBUG_FAT
2899if ( _get_proctime() > GIET_DEBUG_FAT )
2900_printf("\n[DEBUG FAT] _fat_open() : P[%d,%d,%d] found file <%s> on device : inode = %x\n",
2901        x , y , p , pathname , child );
2902#endif
2903
2904    }
2905
2906    // Search an empty slot in file descriptors array
2907    fd_id = 0;
2908    while ( (_fat.fd[fd_id].allocated) != 0 && (fd_id < GIET_OPEN_FILES_MAX) )
2909    {
2910        fd_id++;
2911    }
2912
2913    // set file descriptor if an empty slot has been found
2914    if ( fd_id < GIET_OPEN_FILES_MAX )
2915    {
2916        // update file descriptor
2917        _fat.fd[fd_id].allocated  = 1;
2918        _fat.fd[fd_id].seek       = 0;
2919        _fat.fd[fd_id].read_only  = read_only;
2920        _fat.fd[fd_id].inode      = child;
2921
2922        // increment the refcount
2923        child->count = child->count + 1;
2924
2925        // releases the lock
2926        _spin_lock_release( &_fat.fat_lock );
2927
2928#if GIET_DEBUG_FAT
2929if ( _get_proctime() > GIET_DEBUG_FAT )
2930_printf("\n[DEBUG FAT] _fat_open() : P[%d,%d,%d] got fd = %d for <%s> / "
2931        "read_only = %d\n",
2932        x , y , p , fd_id , pathname , read_only );
2933#endif
2934        return fd_id;
2935    }
2936    else
2937    {
2938        _spin_lock_release( &_fat.fat_lock );
2939        _printf("\n[FAT ERROR] in _fat_open() : File-Descriptors-Array full\n");
2940        return -9;
2941    }
2942} // end _fat_open()
2943
2944
2945
2946
2947/////////////////////////////////////////////////////////////////////////////////
2948// This function implements the "giet_fat_close()" system call.
2949// It decrements the inode reference count, and release the fd_id entry
2950// in the file descriptors array.
2951// If the reference count is zero, it writes all dirty clusters on block device,
2952// and releases the memory allocated to the file_cache: The cache 64-Tree
2953// infrastructure (depending on file size) is kept, but all buffers and all
2954// buffer descriptors are released.
2955/////////////////////////////////////////////////////////////////////////////////
2956// Returns 0 on success.
2957// Returns negative value if error:
2958//  -1  : "FAT not initialised"
2959//  -2  : "Illegal file descriptor"
2960//  -3  : "Cannot update DATA region for closed file"
2961//  -4  : "Cannot release memory"
2962/////////////////////////////////////////////////////////////////////////////////
2963int _fat_close( unsigned int fd_id )
2964{
2965    // checking FAT initialised
2966    if( _fat.initialised != FAT_INITIALISED )
2967    {
2968        _printf("\n[FAT ERROR] in _fat_close() : FAT not initialised\n");
2969        return -1;
2970    }
2971
2972    if( (fd_id >= GIET_OPEN_FILES_MAX) )
2973    {
2974        _printf("\n[FAT ERROR] in _fat_close() : illegal file descriptor index\n");
2975        return -2;
2976    } 
2977
2978    // takes lock
2979    _spin_lock_acquire( &_fat.fat_lock );
2980
2981    // get the inode pointer
2982    fat_inode_t*  inode = _fat.fd[fd_id].inode;
2983
2984    // decrement reference count
2985    inode->count = inode->count - 1;
2986   
2987#if GIET_DEBUG_FAT
2988if ( _get_proctime() > GIET_DEBUG_FAT )
2989_printf("\n[FAT DEBUG] _fat_close() for file <%s> : refcount = %d\n",
2990        inode->name , inode->count );
2991#endif
2992
2993    // update block device and release File-Cache if no more references
2994    if ( inode->count == 0 )
2995    {
2996        // update all dirty clusters for closed file
2997        if ( _update_device_from_cache( inode->levels, 
2998                                        inode->cache,
2999                                        inode->name ) ) 
3000        {
3001            _spin_lock_release( &_fat.fat_lock );
3002            _printf("\n[FAT ERROR] in _fat_close() : cannot write dirty clusters "
3003                    "for file <%s>\n", inode->name );
3004            return -3;
3005        }
3006
3007#if GIET_DEBUG_FAT
3008if ( _get_proctime() > GIET_DEBUG_FAT )
3009_printf("\n[FAT DEBUG] _fat_close() update device for file <%s>\n", inode->name );
3010#endif
3011
3012        // update directory dirty clusters for parent directory
3013        if ( _update_device_from_cache( inode->parent->levels, 
3014                                        inode->parent->cache,
3015                                        inode->parent->name ) ) 
3016        {
3017            _spin_lock_release( &_fat.fat_lock );
3018            _printf("\n[FAT ERROR] in _fat_close() : cannot write dirty clusters "
3019                    "for directory <%s>\n", inode->parent->name );
3020            return -4;
3021        }
3022
3023#if GIET_DEBUG_FAT
3024if ( _get_proctime() > GIET_DEBUG_FAT )
3025_printf("\n[FAT DEBUG] _fat_close() update device for parent directory <%s>\n",
3026        inode->parent->name );
3027#endif
3028
3029        // release memory allocated to File-Cache
3030        if ( _release_cache_memory( inode->cache,
3031                                    inode-> levels ) )
3032        {
3033            _spin_lock_release( &_fat.fat_lock );
3034            _printf("\n[FAT ERROR] in _fat_close() : cannot release cache memory "
3035                    "for file <%s>\n", _fat.fd[fd_id].inode->name );
3036            return -5;
3037        }
3038
3039#if GIET_DEBUG_FAT
3040if ( _get_proctime() > GIET_DEBUG_FAT )
3041_printf("\n[FAT DEBUG] _fat_close() release memory for File-Cache <%s>\n",
3042        inode->name );
3043#endif
3044
3045    }
3046
3047    // release fd_id entry in file descriptor array
3048    _fat.fd[fd_id].allocated = 0;
3049
3050    // release lock
3051    _spin_lock_release( &_fat.fat_lock );
3052
3053    return 0;
3054} // end fat_close()
3055
3056
3057
3058
3059/////////////////////////////////////////////////////////////////////////////////
3060// This function implements the giet_fat_file_info() system call.
3061// It returns the size and the current offset value for a file identified
3062// by the "fd_id" argument.
3063/////////////////////////////////////////////////////////////////////////////////
3064// Returns  0 if success.
3065// Returns negative value if error.
3066//  -1  : "FAT not initialised"
3067//  -2  : "Illegal file descriptor"
3068//  -3  : "File not open"
3069/////////////////////////////////////////////////////////////////////////////////
3070int _fat_file_info( unsigned int   fd_id,
3071                    unsigned int*  size,
3072                    unsigned int*  offset )
3073{
3074    // checking FAT initialised
3075    if( _fat.initialised != FAT_INITIALISED )
3076    {
3077        _printf("\n[FAT ERROR] in _fat_file_info() : FAT not initialised\n");
3078        return -1;
3079    }
3080
3081
3082    if( fd_id >= GIET_OPEN_FILES_MAX )
3083    {
3084        _printf("\n[FAT ERROR] in _fat_file_info() : illegal file descriptor index\n");
3085        return -2;
3086    } 
3087
3088    if ( _fat.fd[fd_id].allocated == 0 )
3089    {
3090        _printf("\n[FAT ERROR] in _fat_file_info() : file <%s> not open\n",
3091                _fat.fd[fd_id].inode->name );
3092        return -3;
3093    }
3094
3095    *size   = _fat.fd[fd_id].inode->size;
3096    *offset = _fat.fd[fd_id].seek; 
3097    return 0;
3098
3099} // end _fat_file_info()
3100
3101
3102
3103
3104/////////////////////////////////////////////////////////////////////////////////
3105// The following function implements the "giet_fat_read()" system call.
3106// It transfers "count" bytes from the File_Cache associated to the file
3107// identified by "fd_id", to the user "buffer", from the current file offset.
3108// It has the same semantic as the UNIX "read()" function.
3109// In case of miss in the File_Cache, it loads all involved clusters into cache.
3110/////////////////////////////////////////////////////////////////////////////////
3111// Returns number of bytes actually transfered if success .
3112// Returns 0 if EOF encountered (offset + count > file_size).
3113// Returns a negative value if error:
3114//   -1 :  "fat not initialised"
3115//   -2 :  "file not open"
3116//   -3 :  "cannot load file from device"
3117/////////////////////////////////////////////////////////////////////////////////
3118int _fat_read( unsigned int fd_id,     // file descriptor index
3119               void*        buffer,    // destination buffer
3120               unsigned int count )    // number of bytes to read
3121{
3122    // checking FAT initialised
3123    if( _fat.initialised != FAT_INITIALISED )
3124    {
3125        _printf("\n[FAT ERROR] in _fat_write() : FAT not initialised\n");
3126        return -1;
3127    }
3128
3129    // check fd_id overflow
3130    if ( fd_id >= GIET_OPEN_FILES_MAX )
3131    {
3132        _printf("\n[FAT ERROR] in _fat_read() : illegal file descriptor\n");
3133        return -1;
3134    }
3135
3136    // check file is open
3137    if ( _fat.fd[fd_id].allocated == 0 )
3138    {
3139        _printf("\n[FAT ERROR] in _fat_read() : file not open\n");
3140        return -2;
3141    }
3142
3143    // takes lock
3144    _spin_lock_acquire( &_fat.fat_lock );
3145           
3146    // get file inode pointer and offset
3147    fat_inode_t* inode  = _fat.fd[fd_id].inode;
3148    unsigned int seek   = _fat.fd[fd_id].seek;
3149
3150    // check count & seek versus file size
3151    if ( count + seek > inode->size )
3152    {
3153        _spin_lock_release( &_fat.fat_lock );
3154        _printf("\n[FAT ERROR] in _fat_read() : file too small"
3155                " / seek = %x / count = %x / file_size = %x\n",
3156                seek , count , inode->size );
3157        return 0;
3158    }
3159
3160    // compute first_cluster_id and first_byte_to_move
3161    unsigned int first_cluster_id   = seek >> 12;
3162    unsigned int first_byte_to_move = seek & 0xFFF;   
3163
3164    // compute last_cluster and last_byte_to_move
3165    unsigned int last_cluster_id   = (seek + count - 1) >> 12;   
3166    unsigned int last_byte_to_move = (seek + count - 1) & 0xFFF;
3167
3168#if GIET_DEBUG_FAT
3169unsigned int procid  = _get_procid();
3170unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3171unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3172unsigned int p       = procid & ((1<<P_WIDTH)-1);
3173if ( _get_proctime() > GIET_DEBUG_FAT )
3174_printf("\n[DEBUG FAT] _fat_read() : P[%d,%d,%d] enters for file <%s> "
3175        " / bytes = %x / offset = %x\n"
3176        "first_cluster_id = %x / first_byte_to_move = %x"
3177        " / last_cluster_id = %x / last_byte_to_move = %x\n",
3178        x , y , p , inode->name , count , seek ,
3179        first_cluster_id , first_byte_to_move , last_cluster_id , last_byte_to_move );
3180#endif
3181
3182    // loop on all cluster covering the requested transfer
3183    unsigned int cluster_id;
3184    unsigned int done = 0;
3185    for ( cluster_id = first_cluster_id ; cluster_id <= last_cluster_id ; cluster_id++ )
3186    {
3187        // get pointer on the cluster_id buffer in cache
3188        unsigned char*     cbuf;
3189        fat_cache_desc_t*  pdesc;
3190        if ( _get_buffer_from_cache( inode, 
3191                                     cluster_id,
3192                                     &pdesc ) )
3193        {
3194            _spin_lock_release( &_fat.fat_lock );
3195            _printf("\n[FAT ERROR] in _fat_read() : cannot load file <%s>\n",
3196                    inode->name );
3197            return -3;
3198        }
3199        cbuf = pdesc->buffer;
3200
3201#if GIET_DEBUG_FAT
3202if ( _get_proctime() > GIET_DEBUG_FAT )
3203_printf("\n[DEBUG FAT] _fat_read() : P[%d,%d,%d] moves cluster_id %d from Cache-File <%s>\n",
3204        x , y , p , cluster_id, inode->name );
3205#endif
3206
3207        // compute memcpy arguments
3208        unsigned char*  source;
3209        unsigned int    nbytes;
3210        unsigned char*  dest = (unsigned char*)buffer + done;
3211        if ( (cluster_id == first_cluster_id) && (cluster_id == last_cluster_id) )
3212        {
3213            source = cbuf + first_byte_to_move; 
3214            nbytes = last_byte_to_move - first_byte_to_move + 1;
3215        }
3216        else if ( cluster_id == first_cluster_id )
3217        {
3218            source = cbuf + first_byte_to_move; 
3219            nbytes = 4096 - first_byte_to_move;
3220        }
3221        else if ( cluster_id == last_cluster_id )
3222        {
3223            source = cbuf; 
3224            nbytes = last_byte_to_move + 1;
3225        }
3226        else  // not first / not last
3227        {
3228            source = cbuf; 
3229            nbytes = 4096;
3230        }
3231
3232        // move data
3233        memcpy( dest , source , nbytes );
3234        done = done + nbytes;
3235    }
3236
3237#if GIET_DEBUG_FAT
3238if ( _get_proctime() > GIET_DEBUG_FAT )
3239_printf("\n[DEBUG FAT] _fat_read() : P[%d,%d,%d] loaded file <%s> from Cache-File\n",
3240        x , y , p , inode->name );
3241#endif
3242
3243    // update seek
3244    _fat.fd[fd_id].seek += done;
3245
3246    // release lock
3247    _spin_lock_release( &_fat.fat_lock );
3248
3249    return done;
3250} // end _fat_read()
3251
3252
3253
3254
3255/////////////////////////////////////////////////////////////////////////////////
3256// The following function implements the "giet_fat_write()" system call.
3257// It transfers "count" bytes to the fat_cache associated to the file
3258// identified by "fd_id", from the user "buffer", using the current file offset.
3259// It has the same semantic as the UNIX "write()" function.
3260// It increases the file size and allocate new clusters if (count + offset)
3261// is larger than the current file size. Then it loads and updates all
3262// involved clusters in the cache.
3263/////////////////////////////////////////////////////////////////////////////////
3264// Returns number of bytes actually written if success.
3265// Returns a negative value if error:
3266//   -1 :  "FAT not initialised"
3267//   -2 :  "Illegal file descriptor"
3268//   -3 :  "File not open"
3269//   -4 :  "File not writable"
3270//   -5 :  "No free clusters"
3271//   -6 :  "Cannot update parent directory entry"
3272//   -7 :  "Cannot access File-Cache"
3273/////////////////////////////////////////////////////////////////////////////////
3274int _fat_write( unsigned int fd_id,    // file descriptor index
3275                void*        buffer,   // source buffer
3276                unsigned int count )   // number of bytes to write
3277{
3278    // checking FAT initialised
3279    if( _fat.initialised != FAT_INITIALISED )
3280    {
3281        _printf("\n[FAT ERROR] in _fat_write() : FAT not initialised\n");
3282        return -1;
3283    }
3284
3285    // takes lock
3286    _spin_lock_acquire( &_fat.fat_lock );
3287           
3288    // check fd_id overflow
3289    if ( fd_id >= GIET_OPEN_FILES_MAX )
3290    {
3291        _spin_lock_release( &_fat.fat_lock );
3292        _printf("\n[FAT ERROR] in _fat_write() : illegal file descriptor\n");
3293        return -2;
3294    }
3295
3296    // check file open
3297    if ( _fat.fd[fd_id].allocated == 0 )
3298    {
3299        _spin_lock_release( &_fat.fat_lock );
3300        _printf("\n[FAT ERROR] in _fat_write() : file not open\n" );
3301        return -3;
3302    }
3303
3304    // check file writable
3305    if ( _fat.fd[fd_id].read_only )
3306    {
3307        _spin_lock_release( &_fat.fat_lock );
3308        _printf("\n[FAT ERROR] in _fat_write() : file <%s> is read-only\n",
3309                _fat.fd[fd_id].inode->name );
3310        return -4;
3311    }
3312
3313    // get file inode pointer and seek
3314    fat_inode_t* inode  = _fat.fd[fd_id].inode;
3315    unsigned int seek   = _fat.fd[fd_id].seek;
3316
3317#if GIET_DEBUG_FAT
3318unsigned int procid  = _get_procid();
3319unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3320unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3321unsigned int p       = procid & ((1<<P_WIDTH)-1);
3322if ( _get_proctime() > GIET_DEBUG_FAT )
3323_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] enters for file <%s> "
3324        " / bytes = %x / seek = %x\n",
3325        x , y , p , inode->name , count , seek );
3326#endif
3327
3328    // chek if file size must be incremented
3329    // and allocate new clusters from FAT if required
3330    unsigned int old_size = inode->size;
3331    unsigned int new_size = seek + count;
3332    if ( new_size > old_size )
3333    {
3334        // update size in inode
3335        inode->size = new_size;
3336 
3337        // compute current and required numbers of clusters
3338        unsigned old_clusters = old_size >> 12;
3339        if ( old_size & 0xFFF ) old_clusters++;
3340
3341        unsigned new_clusters = new_size >> 12;
3342        if ( new_size & 0xFFF ) new_clusters++;
3343
3344        // allocate new clusters from FAT if required
3345        if ( new_clusters > old_clusters )
3346        {
3347
3348#if GIET_DEBUG_FAT
3349if ( _get_proctime() > GIET_DEBUG_FAT )
3350_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] allocates new clusters for file <%s>"
3351        " / current = %d / required = %d\n",
3352        x , y , p , inode->name , old_clusters , new_clusters );
3353#endif
3354            // allocate missing clusters
3355            if ( _clusters_allocate( inode,
3356                                     old_clusters,
3357                                     new_clusters - old_clusters ) )
3358            {
3359                _spin_lock_release( &_fat.fat_lock );
3360                _printf("\n[FAT ERROR] in _fat_write() : no free clusters"
3361                        " for file <%s>\n", _fat.fd[fd_id].inode->name );
3362                return -5;
3363            }
3364        }
3365         
3366        // update parent directory entry (size an cluster index)
3367        if ( _update_dir_entry( inode ) )
3368        {
3369            _spin_lock_release( &_fat.fat_lock );
3370            _printf("\n[FAT ERROR] in _fat_write() : cannot update parent directory entry"
3371                    " for file <%s>\n", _fat.fd[fd_id].inode->name );
3372            return -6;
3373        }
3374           
3375
3376#if GIET_DEBUG_FAT
3377if ( _get_proctime() > GIET_DEBUG_FAT )
3378_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] updates size for file <%s> / size = %x\n",
3379        x , y , p , inode->name , (new_size - old_size) );
3380#endif
3381
3382    }
3383
3384    // compute first_cluster_id and first_byte_to_move
3385    unsigned int first_cluster_id   = seek >> 12;
3386    unsigned int first_byte_to_move = seek & 0xFFF;   
3387
3388    // compute last_cluster and last_byte_to_move
3389    unsigned int last_cluster_id   = (seek + count - 1) >> 12;   
3390    unsigned int last_byte_to_move = (seek + count - 1) & 0xFFF;
3391
3392#if GIET_DEBUG_FAT
3393if ( _get_proctime() > GIET_DEBUG_FAT )
3394_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] starts loop on clusters for file <%s>\n"
3395        "  first_cluster_id = %d / first_byte_to_move = %x"
3396        " / last_cluster_id = %d / last_byte_to_move = %x\n",
3397        x , y , p , inode->name ,
3398        first_cluster_id , first_byte_to_move , last_cluster_id , last_byte_to_move );
3399#endif
3400
3401    // loop on all clusters covering the requested transfer
3402    unsigned int cluster_id;
3403    unsigned int done = 0;
3404    for ( cluster_id = first_cluster_id ; cluster_id <= last_cluster_id ; cluster_id++ )
3405    {
3406        // get pointer on one 4K buffer in File-Cache
3407        unsigned char*     cbuf;
3408        fat_cache_desc_t*  pdesc;
3409        if ( _get_buffer_from_cache( inode,   
3410                                     cluster_id, 
3411                                     &pdesc ) )   
3412        {
3413            _spin_lock_release( &_fat.fat_lock );
3414            _printf("\n[FAT ERROR] in _fat_write() : cannot load file <%s>\n",
3415                    inode->name );
3416            return -7;
3417        }
3418       
3419        cbuf         = pdesc->buffer;
3420        pdesc->dirty = 1;
3421   
3422#if GIET_DEBUG_FAT
3423if ( _get_proctime() > GIET_DEBUG_FAT )
3424_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] move cluster_id %d to Cache-file <%s>\n",
3425        x , y , p , cluster_id, inode->name );
3426#endif
3427
3428        // compute memcpy arguments
3429        unsigned char* source = (unsigned char*)buffer + done;
3430        unsigned char* dest;
3431        unsigned int   nbytes;
3432        if ( (cluster_id == first_cluster_id) && (cluster_id == last_cluster_id) )
3433        {
3434            dest   = cbuf + first_byte_to_move; 
3435            nbytes = last_byte_to_move - first_byte_to_move + 1;
3436        }
3437        else if ( cluster_id == first_cluster_id )
3438        {
3439            dest   = cbuf + first_byte_to_move; 
3440            nbytes = 4096 - first_byte_to_move;
3441        }
3442        else if ( cluster_id == last_cluster_id )
3443        {
3444            dest   = cbuf; 
3445            nbytes = last_byte_to_move + 1;
3446        }
3447        else
3448        {
3449            dest   = cbuf; 
3450            nbytes = 4096;
3451        }
3452
3453        //move date
3454        memcpy( dest , source , nbytes ); 
3455        done = done + nbytes;
3456
3457    } // end for clusters
3458
3459    // update seek
3460    _fat.fd[fd_id].seek += done;
3461
3462#if GIET_DEBUG_FAT
3463if ( _get_proctime() > GIET_DEBUG_FAT )
3464_printf("\n[DEBUG FAT] _fat_write() : P[%d,%d,%d] store file <%s> into Cache-File\n",
3465        x , y , p , inode->name );
3466#endif
3467
3468    // release lock
3469    _spin_lock_release( &_fat.fat_lock );
3470
3471    return done;
3472} // end _fat_write()
3473
3474
3475
3476/////////////////////////////////////////////////////////////////////////////////
3477// The following function implements the "giet_fat_lseek()" system call.
3478// It repositions the seek in the file descriptor "fd_id", according to
3479// the "seek" and "whence" arguments.
3480// It has the same semantic as the UNIX lseek() function.
3481// Accepted values for whence are SEEK_SET and SEEK_CUR.
3482/////////////////////////////////////////////////////////////////////////////////
3483// Returns new seek value (bytes) if success.
3484// Returns negative value if error:
3485//   -1  : "FAT not initialised"
3486//   -2  : "Illegal file descriptor"
3487//   -3  : "File not open"
3488//   -4  : "Illegal whence argument"
3489/////////////////////////////////////////////////////////////////////////////////
3490int _fat_lseek( unsigned int fd_id,
3491                unsigned int seek,
3492                unsigned int whence )
3493{
3494    // checking FAT initialised
3495    if( _fat.initialised != FAT_INITIALISED )
3496    {
3497        _printf("\n[FAT ERROR] in _fat_lseek() : FAT not initialised\n");
3498        return -1;
3499    }
3500
3501    // check fd_id overflow
3502    if ( fd_id >= GIET_OPEN_FILES_MAX )
3503    {
3504        _printf("\n[FAT ERROR] in _fat_lseek() : illegal file descriptor\n");
3505        return -2;
3506    }
3507
3508    // takes lock
3509    _spin_lock_acquire( &_fat.fat_lock );
3510
3511    // check file open
3512    if ( _fat.fd[fd_id].allocated == 0 )
3513    {
3514        _spin_lock_release( &_fat.fat_lock );
3515        _printf("\n[FAT ERROR] in _fat_lseek() : file not open\n");
3516        return -3;
3517    }
3518
3519    unsigned int  new_seek;
3520
3521    // compute new seek
3522    if      ( whence == SEEK_CUR ) new_seek = _fat.fd[fd_id].seek + seek;
3523    else if ( whence == SEEK_SET ) new_seek = seek;
3524    else
3525    {
3526        _spin_lock_release( &_fat.fat_lock );
3527        _printf("\n[FAT ERROR] in _fat_user_lseek() : illegal whence valuel\n");
3528        return -4;
3529    }
3530
3531    // update file descriptor offset
3532    _fat.fd[fd_id].seek = new_seek;
3533
3534#if GIET_DEBUG_FAT
3535unsigned int procid  = _get_procid();
3536unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3537unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3538unsigned int p       = procid & ((1<<P_WIDTH)-1);
3539if ( _get_proctime() > GIET_DEBUG_FAT )
3540_printf("\n[DEBUG FAT] _fat_lseek() : P[%d,%d,%d] set seek = %x for file <%s>\n",
3541        x , y , p , new_seek , _fat.fd[fd_id].inode->name );
3542#endif
3543
3544    // release lock
3545    _spin_lock_release( &_fat.fat_lock );
3546
3547    return new_seek;
3548}  // end _fat_lseek()
3549
3550
3551
3552/////////////////////////////////////////////////////////////////////////////////
3553// The following function implements the giet_fat_remove() system call.
3554// It deletes the file/directory identified by the "pathname" argument from
3555// the file system, if the remove condition is fulfilled (directory empty,
3556// or file not referenced).
3557// All clusters allocated in the block device DATA region are released.
3558// The FAT region is updated on the block device.
3559// The Inode-Tree is updated.
3560// The associated File_Cache is released.
3561// The Fat_Cache is updated.
3562/////////////////////////////////////////////////////////////////////////////////
3563// Returns 0 if success.
3564// Returns negative value if error
3565//   -1  : "FAT not initialised"
3566//   -2  : "File/Directory not found"
3567//   -3  : "Name too long in path"
3568//   -4  : "Has the wrong type"
3569//   -5  : "File still open"
3570//   -6  : "Cannot scan directory"
3571//   -7  : "Directory not empty"
3572//   -8  : "Cannot remove file/dir from FS"
3573/////////////////////////////////////////////////////////////////////////////////
3574int _fat_remove( char*        pathname,
3575                 unsigned int should_be_dir )
3576{
3577    fat_inode_t*  inode;            // searched file inode pointer
3578
3579#if GIET_DEBUG_FAT
3580unsigned int procid  = _get_procid();
3581unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3582unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3583unsigned int p       = procid & ((1<<P_WIDTH)-1);
3584if ( _get_proctime() > GIET_DEBUG_FAT )
3585_printf("\n[DEBUG FAT] _fat_remove() : P[%d,%d,%d] enters for path <%s>\n",
3586        x, y, p, pathname );
3587#endif
3588
3589    // checking FAT initialised
3590    if( _fat.initialised != FAT_INITIALISED )
3591    {
3592        _printf("\n[FAT ERROR] in _fat_remove() : FAT not initialised\n");
3593        return -1;
3594    }
3595
3596    // take the lock
3597    _spin_lock_acquire( &_fat.fat_lock );
3598
3599    // get searched file inode
3600    unsigned int code = _get_inode_from_path( pathname , &inode );
3601
3602#if GIET_DEBUG_FAT
3603if ( _get_proctime() > GIET_DEBUG_FAT )
3604_printf("\n[DEBUG FAT] _fat_remove() : P[%d,%d,%d] found inode %x for <%s> / code = %d\n",
3605        x , y , p , (unsigned int)inode , pathname , code );
3606#endif
3607
3608    if ( (code == 1) || (code == 2) )
3609    {
3610        _spin_lock_release( &_fat.fat_lock );
3611        _printf("\n[FAT ERROR] in _fat_remove() : file <%s> not found\n", 
3612                pathname );
3613        return -2;
3614    }
3615    else if ( code == 3 )
3616    {
3617        _spin_lock_release( &_fat.fat_lock );
3618        _printf("\n[FAT ERROR] in _fat_remove() : name too long in <%s>\n",
3619                pathname );
3620        return -3;
3621    }
3622
3623    // check inode type
3624    if ( (inode->is_dir != 0) && (should_be_dir == 0) ) 
3625    {
3626        _spin_lock_release( &_fat.fat_lock );
3627        _printf("\n[FAT ERROR] in _fat_remove() : <%s> is a directory\n",
3628                pathname );
3629        return -4;
3630    }
3631    if ( (inode->is_dir == 0) && (should_be_dir != 0) )
3632    {
3633        _spin_lock_release( &_fat.fat_lock );
3634        _printf("\n[FAT ERROR] in _fat_remove() : <%s> is not a directory\n", 
3635                pathname );
3636        return -4;
3637    }
3638
3639#if GIET_DEBUG_FAT
3640if ( _get_proctime() > GIET_DEBUG_FAT )
3641_printf("\n[DEBUG FAT] _fat_remove() : P[%d,%d,%d] checked inode type for <%s>\n",
3642        x , y , p , pathname );
3643#endif
3644   
3645    // check references count for a file
3646    if ( (inode->is_dir == 0) && (inode->count != 0) )
3647    {
3648        _spin_lock_release( &_fat.fat_lock );
3649        _printf("\n[FAT ERROR] in _fat_remove() : file <%s> still referenced\n",
3650                pathname );
3651        return -5;
3652    }
3653
3654    //  check empty for a directory
3655    if ( inode->is_dir )
3656    {
3657        unsigned int entries;
3658        if ( _get_nb_entries( inode , &entries ) )
3659        {
3660            _spin_lock_release( &_fat.fat_lock );
3661            _printf("\n[FAT ERROR] in _fat_remove() : cannot scan directory <%s>\n", 
3662                    pathname );
3663            return -6;
3664        }
3665        else if ( entries > 2 )
3666        {
3667            _spin_lock_release( &_fat.fat_lock );
3668            _printf("\n[FAT ERROR] in _fat_remove() : directory <%s> not empty\n", 
3669                    pathname );
3670            return -7;
3671        }
3672    }
3673
3674#if GIET_DEBUG_FAT
3675if ( _get_proctime() > GIET_DEBUG_FAT )
3676_printf("\n[DEBUG FAT] _fat_remove() : P[%d,%d,%d] checked remove condition OK for <%s>\n",
3677        x , y , p , pathname );
3678#endif
3679   
3680    // remove the file or directory from the file system
3681    if ( _remove_node_from_fs( inode ) )
3682    {
3683        _spin_lock_release( &_fat.fat_lock );
3684        _printf("\n[FAT ERROR] in _fat_remove() : cannot remove <%s> from FS\n",
3685                pathname );
3686        return -8;
3687    }
3688
3689    // release lock and return success
3690    _spin_lock_release( &_fat.fat_lock );
3691
3692#if GIET_DEBUG_FAT
3693if ( _get_proctime() > GIET_DEBUG_FAT )
3694_printf("\n[DEBUG FAT] _fat_remove() : P[%d,%d,%d] removed  <%s> from FS\n",
3695        x, y, p, pathname );
3696#endif
3697   
3698    return 0;
3699       
3700}  // end _fat_remove()
3701
3702
3703
3704
3705
3706/////////////////////////////////////////////////////////////////////////////////
3707// This function implements the giet_fat_rename() system call.
3708// It moves an existing file or directory from one node (defined by "old_path"
3709// argument) to another node (defined by "new_path" argument) in the FS tree.
3710// The type (file/directory) and content are not modified.
3711// If the new_path file/dir exist, it is removed from the file system, but only 
3712// if the remove condition is respected (directory empty / file not referenced).
3713// The removed entry is only removed after the new entry is actually created.
3714/////////////////////////////////////////////////////////////////////////////////
3715// Returns 0 if success.
3716// Returns a negative value if error:
3717//  -1  : "FAT not initialised"
3718//  -2  : "old_path not found"
3719//  -3  : "new_path not found"
3720//  -4  : "cannot scan to_remove directory"
3721//  -5  : "to_remove directory not empty"
3722//  -6  : "to_remove file still referenced"
3723//  -7  : "cannot add new node to new_parent directory"
3724//  -8  : "cannot update new_parent directory on device"
3725//  -9  : "cannot remove old node from old_parent directory"
3726//  -10 : "cannot update old_parent directory on device"
3727//  -11 : "cannot remove to_remove node from FS"
3728/////////////////////////////////////////////////////////////////////////////////
3729int _fat_rename( char*  old_path,
3730                 char*  new_path )
3731{
3732    fat_inode_t*  inode;        // anonymous inode pointer
3733    fat_inode_t*  old;          // inode identified by old_path      => to be deleted
3734    fat_inode_t*  new;          // inode identified by new_path      => to be created
3735    fat_inode_t*  old_parent;   // parent inode  in old_path         => to be modified
3736    fat_inode_t*  new_parent;   // parent inode  in new_path         => to be modified
3737    fat_inode_t*  to_remove;    // previouly identified by new_path  => to be removed
3738    unsigned int  code;
3739
3740#if GIET_DEBUG_FAT
3741unsigned int procid  = _get_procid();
3742unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3743unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3744unsigned int p       = procid & ((1<<P_WIDTH)-1);
3745if ( _get_proctime() > GIET_DEBUG_FAT )
3746_printf("\n[DEBUG FAT] _fat_rename() : P[%d,%d,%d] enters to move <%s> to <%s>\n",
3747        x , y , p , old_path , new_path );
3748#endif
3749
3750    // checking FAT initialised
3751    if( _fat.initialised != FAT_INITIALISED )
3752    {
3753        _printf("\n[FAT ERROR] in _fat_rename() : FAT not initialised\n");
3754        return -1;
3755    }
3756
3757    // take the lock
3758    _spin_lock_acquire( &_fat.fat_lock );
3759
3760    // get "old" and "old_parent" inode pointers
3761    if ( _get_inode_from_path( old_path , &inode ) )
3762    {
3763        _spin_lock_release( &_fat.fat_lock );
3764        _printf("\n[FAT ERROR] in _fat_rename() : <%s> not found\n", old_path );
3765        return -2;
3766    }
3767    else
3768    {
3769        old        = inode;
3770        old_parent = inode->parent;
3771    }
3772
3773    // get "to_removed" and "new_parent" inode pointers
3774    code = _get_inode_from_path( new_path , &inode );
3775
3776    if ( code == 0 )       // new_path inode already exist
3777    {
3778        to_remove        = inode;
3779        new_parent       = inode->parent;   
3780    }
3781    else if ( code == 1 )  // to_remove does not exist but parent exist
3782    {
3783        to_remove        = NULL;
3784        new_parent       = inode;
3785    }
3786    else                   // parent directory in new_path not found
3787    {
3788        _spin_lock_release( &_fat.fat_lock );
3789        _printf("\n[FAT ERROR] in _fat_rename() : <%s> not found\n", new_path );
3790        return -3;
3791    }
3792
3793#if GIET_DEBUG_FAT
3794if ( _get_proctime() > GIET_DEBUG_FAT )
3795{
3796if ( to_remove )
3797_printf("\n[DEBUG FAT] _fat_rename() : old_parent = %s / old = %s / new_parent = %s "
3798        "/ to_remove = %s\n",
3799        old_parent->name , old->name , new_parent->name , to_remove->name );
3800else
3801_printf("\n[DEBUG FAT] _fat_rename() : old_parent = %s / old = %s / new_parent = %s "
3802        "/ no remove\n", 
3803        old_parent->name , old->name , new_parent->name );
3804}
3805#endif
3806
3807    // check remove condition for "to_remove" inode
3808    if ( to_remove )
3809    {
3810        if ( to_remove->is_dir )   // it's a directory
3811        {
3812            unsigned int entries;
3813            if ( _get_nb_entries( to_remove , &entries ) )
3814            {
3815                _spin_lock_release( &_fat.fat_lock );
3816                _printf("\n[FAT ERROR] in _fat_rename() : cannot scan directory <%s>\n", 
3817                        to_remove->name );
3818                return -4;
3819            }
3820            else if ( entries > 2 )
3821            {
3822                _spin_lock_release( &_fat.fat_lock );
3823                _printf("\n[FAT ERROR] in _fat_rename() : directory <%s> not empty\n", 
3824                        to_remove->name );
3825                return -5;
3826            }
3827        }
3828        else                       // it's a file
3829        {
3830            if ( to_remove->count ) 
3831            {
3832                _spin_lock_release( &_fat.fat_lock );
3833                _printf("\n[FAT ERROR] in _fat_rename() : file <%s> still referenced\n", 
3834                        to_remove->name );
3835                return -6;
3836            }
3837        }
3838    }
3839
3840#if GIET_DEBUG_FAT
3841if ( _get_proctime() > GIET_DEBUG_FAT )
3842_printf("\n[FAT DEBUG] _fat_rename() : P[%d,%d,%d] checked remove condition OK\n",
3843        x , y , p );
3844#endif
3845
3846    // get new last name / error checking already done by _get_inode_from_path()
3847    char  new_name[32];
3848    _get_last_name( new_path , new_name );
3849
3850    // allocate "new" inode
3851    new = _allocate_one_inode( new_name,
3852                               old->is_dir,
3853                               old->cluster,
3854                               old->size,
3855                               0,              // count
3856                               0,              // dentry
3857                               0 );            // no cache_allocate
3858 
3859    // give the "old" File-Cache to the "new inode
3860    new->levels = old->levels;
3861    new->cache  = old->cache;
3862
3863    // add "new" to "new_parent" directory File-Cache
3864    if ( _add_dir_entry( new , new_parent ) )
3865    {
3866        _spin_lock_release( &_fat.fat_lock );
3867        _printf("\n[FAT ERROR] in _fat_rename() : cannot add <%s> into <%s>\n",
3868                new->name , new_parent->name );
3869        return -7;
3870    }
3871
3872    // add "new" to "new_parent" directory in Inode-Tree
3873    _add_inode_in_tree( new , new_parent );
3874   
3875    // updates "new_parent" directory on device
3876    if ( _update_device_from_cache( new_parent->levels,
3877                                    new_parent->cache,
3878                                    new_parent->name ) )
3879    {
3880        _spin_lock_release( &_fat.fat_lock );
3881        _printf("\n[FAT ERROR] in _fat_rename() : cannot update <%s> on device\n",
3882                    new_parent->name );
3883        return -8;
3884    }
3885
3886    // remove "old" from "old_parent" File-Cache
3887    if ( _remove_dir_entry( old ) )
3888    {
3889        _spin_lock_release( &_fat.fat_lock );
3890        _printf("\n[FAT ERROR] in _fat_rename() : cannot remove <%s> from <%s>\n",
3891                old->name , old_parent->name );
3892        return -9;
3893    }
3894 
3895    // remove "old" inode from Inode-Tree
3896    _remove_inode_from_tree( old );
3897
3898    // updates "old_parent" directory on device
3899    if ( _update_device_from_cache( old_parent->levels,
3900                                    old_parent->cache,
3901                                    old_parent->name ) )
3902    {
3903        _spin_lock_release( &_fat.fat_lock );
3904        _printf("\n[FAT ERROR] in _fat_rename() : cannot update <%s> on device\n",
3905                    old_parent->name );
3906        return -10;
3907    }
3908
3909    // remove "to_remove" from File System (if required)
3910    if ( to_remove )
3911    {
3912        if ( _remove_node_from_fs( to_remove ) )
3913        {
3914            _spin_lock_release( &_fat.fat_lock );
3915            _printf("\n[FAT ERROR] in _fat_rename() : cannot remove <%s> from FS\n",
3916                    to_remove->name );
3917            return -11;
3918        }
3919    }
3920
3921    // release lock
3922    _spin_lock_release( &_fat.fat_lock );
3923
3924    return 0;
3925}  // end _fat_rename()
3926
3927
3928
3929
3930/////////////////////////////////////////////////////////////////////////////////
3931// The following function implements the giet_fat_mkdir() system call.
3932// It creates in file system the directory specified by the "pathname" argument.
3933// The Inode-Tree is updated.
3934// One cluster is allocated to the new directory.
3935// The associated File-Cache is created.
3936// The FAT region on block device is updated.
3937// The DATA region on block device is updated.
3938/////////////////////////////////////////////////////////////////////////////////
3939// Returns 0 if success.
3940// Returns a negative value if error:
3941//   -1  : "Fat not initialised"
3942//   -2  : "Path to parent not found"
3943//   -3  : "One name in path too long"
3944//   -4  : "Directory already exist"
3945//   -5  : "No free cluster"
3946//   -6  : "Cannot update parent directory"
3947//   -7  : "Cannot update parent DATA region"
3948//   -8  : "Cannot update FAT region"
3949//   -9  : "Cannot update FS-INFO"
3950//   -10 : "Cannot update directory DATA region"
3951/////////////////////////////////////////////////////////////////////////////////
3952int _fat_mkdir( char* pathname )
3953{
3954    fat_inode_t*         inode;            // anonymous inode pointer
3955    fat_inode_t*         child;            // searched directory inode pointer
3956    fat_inode_t*         parent;           // parent directory inode pointer
3957
3958#if GIET_DEBUG_FAT
3959unsigned int procid  = _get_procid();
3960unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
3961unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
3962unsigned int p       = procid & ((1<<P_WIDTH)-1);
3963if ( _get_proctime() > GIET_DEBUG_FAT )
3964_printf("\n[DEBUG FAT] _fat_mkdir() : P[%d,%d,%d] enters for path <%s>\n",
3965        x, y, p, pathname );
3966#endif
3967
3968    // checking FAT initialised
3969    if( _fat.initialised != FAT_INITIALISED )
3970    {
3971        _printf("\n[FAT ERROR] in _fat_mkdir() : FAT not initialised\n");
3972        return -1;
3973    }
3974
3975    // takes the lock
3976    _spin_lock_acquire( &_fat.fat_lock );
3977   
3978    // get inode
3979    unsigned int code = _get_inode_from_path( pathname , &inode );
3980
3981    if ( code == 2 ) 
3982    {
3983        _spin_lock_release( &_fat.fat_lock );
3984        _printf("\n[FAT ERROR] in _fat_mkdir() : path to parent not found"
3985                " for directory <%s>\n", pathname );
3986        return -2;
3987    }
3988    else if ( code == 3 ) 
3989    {
3990        _spin_lock_release( &_fat.fat_lock );
3991        _printf("\n[FAT ERROR] in _fat_mkdir() : one name in path too long"
3992                " for directory  <%s>\n", pathname );
3993        return -3;
3994    }
3995    else if ( code == 0 )
3996    {
3997        _spin_lock_release( &_fat.fat_lock );
3998        _printf("\n[FAT ERROR] in _fat_mkdir() : directory <%s> already exist\n",
3999                pathname );
4000        return -4;
4001    }
4002    else if ( code == 1 )   // directory not found => create
4003    {
4004        parent = inode;
4005
4006#if GIET_DEBUG_FAT
4007if ( _get_proctime() > GIET_DEBUG_FAT )
4008_printf("\n[DEBUG FAT] _fat_mkdir() : P[%d,%d,%d] create new directory <%s>\n",
4009        x , y , p , pathname );
4010#endif
4011
4012        // get directory name / error check already done by _get_inode_from_path()
4013        char name[32];       
4014        _get_last_name( pathname , name );
4015
4016        // allocate one cluster from FAT for the new directory
4017        unsigned int cluster;
4018        if ( _allocate_one_cluster( &cluster ) )
4019        {
4020            _spin_lock_release( &_fat.fat_lock );
4021            _printf("\n[FAT ERROR] in _fat_mkdir() : no free cluster"
4022                    " for directory <%s>\n" , pathname );
4023            return -5;
4024        }
4025
4026        // allocate a new inode and an empty Cache-File
4027        child = _allocate_one_inode( name,
4028                                     1,           // it's a directory
4029                                     cluster, 
4030                                     0,           // size not defined
4031                                     0,           // count
4032                                     0,           // dentry set by _add_dir_entry()
4033                                     1 );         // cache_allocate
4034
4035        // introduce inode in Inode-Tree
4036        _add_inode_in_tree( child , parent );
4037 
4038        // allocate and initialise one 4 Kbytes buffer and associated descriptor
4039        _allocate_one_buffer( child,
4040                              0,            // cluster_id,
4041                              cluster );
4042
4043        _add_special_directories( child, 
4044                                  parent );
4045
4046        // add an entry in the parent directory Cache_file
4047        if ( _add_dir_entry( child , parent ) )
4048        { 
4049            _spin_lock_release( &_fat.fat_lock );
4050            _printf("\n[FAT ERROR] in _fat_mkdir() : cannot update parent directory"
4051                    " for directory <%s>\n" , pathname );
4052            return -6;
4053        } 
4054
4055        // update DATA region on block device for parent directory
4056        if ( _update_device_from_cache( parent->levels,
4057                                        parent->cache,
4058                                        parent->name ) )
4059        {
4060            _spin_lock_release( &_fat.fat_lock );
4061            _printf("\n[FAT ERROR] in _fat_mkdir() : cannot update DATA region "
4062                    " for parent of directory <%s>\n", pathname );
4063            return -7;
4064        }
4065
4066        // update FAT region on block device
4067        if ( _update_device_from_cache( _fat.fat_cache_levels,
4068                                        _fat.fat_cache_root,
4069                                        "FAT" ) )
4070        {
4071            _spin_lock_release( &_fat.fat_lock );
4072            _printf("\n[FAT ERROR] in _fat_mkdir() : cannot update FAT region"
4073                    " for directory <%s>\n", pathname );
4074            return -8;
4075        }
4076
4077        // update FS_INFO sector
4078        if ( _update_fs_info() )
4079        {
4080            _spin_lock_release( &_fat.fat_lock );
4081            _printf("\n[FAT ERROR] in _fat_mkdir() : cannot update FS-INFO"
4082                    " for directory <%s>\n", pathname );
4083            return -9;
4084        }
4085
4086        // update DATA region on block device for the new directory
4087        if ( _update_device_from_cache( child->levels,   
4088                                        child->cache,
4089                                        child->name ) )
4090        {
4091            _spin_lock_release( &_fat.fat_lock );
4092            _printf("\n[FAT ERROR] in _fat_mkdir() : cannot update DATA region"
4093                    " for directory <%s>\n", pathname );
4094            return -10;
4095        }
4096    }  // end create directory
4097
4098    // release lock
4099    _spin_lock_release( &_fat.fat_lock );
4100
4101    return 0;
4102}  // end _fat_mkdir()
4103
4104
4105
4106
4107
4108/////////////////////////////////////////////////////////////////////////////////
4109// The following function implements the giet_fat_list() system call.
4110// It displays the content of a directory identified by the "pathname" argument.
4111// It returns an error code if the pathname is not a directory.
4112/////////////////////////////////////////////////////////////////////////////////
4113// Returns 0 if success.
4114// Returns a negative value if error:
4115//   -1  : "FAT not initialised
4116//   -2  : "Directory not found"
4117//   -3  : "Name in path too long
4118//   -4  : "Not a directory"
4119//   -5  : "Cannot access directory"
4120//   -6  : "Name too long truncated"
4121/////////////////////////////////////////////////////////////////////////////////
4122int _fat_list( char*  pathname )
4123{
4124    fat_inode_t*  inode;
4125
4126    // checking FAT initialised
4127    if( _fat.initialised != FAT_INITIALISED )
4128    {
4129        _printf("\n[FAT ERROR] in _fat_list() : FAT not initialised\n");
4130        return -1;
4131    }
4132
4133#if GIET_DEBUG_FAT
4134unsigned int procid  = _get_procid();
4135unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
4136unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
4137unsigned int p       = procid & ((1<<P_WIDTH)-1);
4138if ( _get_proctime() > GIET_DEBUG_FAT )
4139_printf("\n[DEBUG FAT] _fat_list() : P[%d,%d,%d] enters for path <%s>\n",
4140        x, y, p, pathname );
4141#endif
4142
4143    // get inode
4144    unsigned int code = _get_inode_from_path( pathname , &inode );
4145
4146    if ( (code == 1) || (code == 2) ) 
4147    {
4148        _printf("\n[FAT ERROR] in _fat_list() : directory <%s> not found\n", pathname );
4149        return -2;
4150    }
4151    if ( code == 3 )
4152    {
4153        _printf("\n[FAT ERROR] in _fat_list() : name too long in path <%s>\n", pathname );
4154        return -3;
4155    }
4156
4157    // check found inode is a directory
4158    if ( inode->is_dir == 0 )
4159    {
4160        _printf("\n[FAT ERROR] in _fat_list() : <%s> is not a directory\n", pathname );
4161        return -4;
4162    }
4163
4164#if GIET_DEBUG_FAT
4165if ( _get_proctime() > GIET_DEBUG_FAT )
4166_printf("\n[DEBUG FAT] _fat_list() : P[%d,%d,%d] found inode for path <%s>\n",
4167        x, y, p, pathname );
4168#endif
4169
4170    // scan directory up to end of directory / two embedded loops :
4171    // - loop on the clusters allocated to the directory
4172    // - loop on the directory entries in each 4 Kbytes buffer
4173    unsigned char*     buffer; 
4174    fat_cache_desc_t*  pdesc;
4175    unsigned int       cluster_id = 0;     // cluster index in directory
4176    unsigned int       offset     = 0;     // position in scanned buffer
4177    unsigned int       lfn        = 0;     // number of lfn entries
4178    unsigned int       nb_entries = 0;     // number of directory entries
4179    unsigned int       done       = 0;     // end of directory found
4180    unsigned int       attr;               // ATTR field value
4181    unsigned int       ord;                // ORD field value
4182    char               lfn1[16];           // temporary buffer for string in LFN1
4183    char               lfn2[16];           // temporary buffer for string in LFN2
4184    char               lfn3[16];           // temporary buffer for string in LFN3
4185    char               name[36];           // directory entry full name
4186    unsigned int       cluster;            // directory entry cluster index
4187    unsigned int       size;               // directory entry size
4188    unsigned int       is_dir;             // directory entry is a directory
4189    unsigned int       is_vid;             // directory entry is volume_id
4190
4191    // TODO : define a method to transfer this information to user mode
4192    _printf("\n<%s>   cluster = %x / lba = %x\n", pathname ,
4193            inode->cluster , _cluster_to_lba( inode->cluster) );
4194
4195    while ( done == 0 )
4196    {
4197        // get one 4 Kytes buffer
4198        if ( _get_buffer_from_cache( inode,
4199                                     cluster_id,
4200                                     &pdesc ) ) 
4201        {
4202            _printf("\n[FAT ERROR] in _fat_list() : cannot access <%s>\n", pathname );
4203            return -5;
4204        }
4205        buffer = pdesc->buffer;
4206
4207        // scan this 4 Kbytes buffer
4208        while ( (offset < 4096)  && (done == 0) )
4209        {
4210            attr = _read_entry( DIR_ATTR , buffer + offset , 0 );   
4211            ord  = _read_entry( LDIR_ORD , buffer + offset , 0 );
4212
4213            if (ord == NO_MORE_ENTRY)                 // no more entry in directory => break
4214            {
4215                done = 1;
4216            }
4217            else if ( ord == FREE_ENTRY )             // free entry => skip
4218            {
4219                offset = offset + 32;
4220            }
4221            else if ( attr == ATTR_LONG_NAME_MASK )   // LFN entry => get partial names
4222            {
4223                unsigned int seq = ord & 0x3;
4224                lfn = (seq > lfn) ? seq : lfn;   
4225                if      ( seq == 1 ) _get_name_from_long( buffer + offset, lfn1 );
4226                else if ( seq == 2 ) _get_name_from_long( buffer + offset, lfn2 );
4227                else if ( seq == 3 ) _get_name_from_long( buffer + offset, lfn3 );
4228                offset = offset + 32;
4229            }
4230            else                                 // NORMAL entry
4231            {
4232                if      ( lfn == 0 )
4233                {
4234                    _get_name_from_short( buffer + offset , name );
4235                }
4236                else if ( lfn == 1 )
4237                {
4238                    _strcpy( name , lfn1 );
4239                }   
4240                else if ( lfn == 2 ) 
4241                {
4242                    _strcpy( name      , lfn1 );
4243                    _strcpy( name + 13 , lfn2 );
4244                }
4245                else if ( lfn == 3 ) 
4246                {
4247                    _strcpy( name      , lfn1 );
4248                    _strcpy( name + 13 , lfn2 );
4249                    _strcpy( name + 26 , lfn3 );
4250                }
4251                   
4252                is_dir  = ((attr & ATTR_DIRECTORY) == ATTR_DIRECTORY);
4253                is_vid  = ((attr & ATTR_VOLUME_ID) == ATTR_VOLUME_ID);
4254                size    = (_read_entry( DIR_FILE_SIZE   , buffer + offset , 1 )      ) ;
4255                cluster = (_read_entry( DIR_FST_CLUS_HI , buffer + offset , 1 ) << 16) |
4256                          (_read_entry( DIR_FST_CLUS_LO , buffer + offset , 1 )      ) ;
4257
4258                if ( is_vid == 0 )
4259                {
4260                    // TODO : define a method to transfer this information to user mode
4261                    if (is_dir) _printf("  DIR  | size = %X | cluster = %X | %s\n",
4262                                        size , cluster, name );
4263                    else        _printf("  FILE | size = %X | cluster = %X | %s\n",
4264                                        size , cluster, name );
4265                    nb_entries++;
4266                }
4267               
4268                offset = offset + 32;
4269                lfn    = 0;
4270            }
4271        }  // end loop on directory entries
4272
4273        if ( done == 0 )
4274        {
4275            cluster_id++;
4276            offset = 0;
4277        }
4278    }  // end loop on buffers
4279
4280    // TODO : define a method to transfer this information to user mode
4281    _printf("  total = %d entries\n", nb_entries );
4282
4283    return 0;
4284} // end _fat_list()
4285
4286
4287
4288
4289
4290///////////////////////////////////////////////////////////////////////////////
4291// This functiond load a file identified by the "pathname" argument into the
4292// memory buffer defined by the "buffer_vbase" and "buffer_size" arguments.
4293// It is intended to be called by the boot-loader, as it does not use the
4294// dynamically allocated FAT structures (Inode-Tree, Fat_Cache or File-Cache,
4295// File-Descriptor-Array).
4296// It uses only the 512 bytes buffer defined in the FAT descriptor.
4297///////////////////////////////////////////////////////////////////////////////
4298// Returns  0 if success.
4299// Returns negative value if error:
4300//  -1  : "FAT not initialised"
4301//  -2  : "File not found"
4302//  -3  : "Buffer too small"
4303//  -4  : "Cannot access block device"
4304//  -5  : "Cannot access FAT on block device"
4305///////////////////////////////////////////////////////////////////////////////
4306int _fat_load_no_cache( char*        pathname,
4307                        unsigned int buffer_vbase, 
4308                        unsigned int buffer_size ) 
4309{
4310    // checking FAT initialised
4311    if( _fat.initialised != FAT_INITIALISED )
4312    {
4313        _printf("\n[FAT ERROR] in _fat_load_no_cache() : FAT not initialised\n");
4314        return -1;
4315    }
4316
4317    unsigned int  file_size;
4318    unsigned int  cluster;
4319
4320#if GIET_DEBUG_FAT
4321unsigned int procid  = _get_procid();
4322unsigned int x       = procid >> (Y_WIDTH + P_WIDTH);
4323unsigned int y       = (procid >> P_WIDTH) & ((1<<Y_WIDTH)-1);
4324unsigned int p       = procid & ((1<<P_WIDTH)-1);
4325if ( _get_proctime() > GIET_DEBUG_FAT )
4326_printf("\n[DEBUG FAT] _fat_load_no_cache() : P[%d,%d,%d] enters for file <%s>\n",
4327        x , y , p , pathname );
4328#endif
4329
4330    // get file size, and cluster index in FAT
4331    if ( _file_info_no_cache( pathname,
4332                              &cluster,
4333                              &file_size ) )
4334    {
4335        _printf("\n[FAT ERROR] in _fat_load_no_cache() : file <%s> not found\n",
4336        pathname );
4337        return -2;
4338    }
4339
4340    // check buffer size
4341    if ( file_size > buffer_size )
4342    {
4343        _printf("\n[FAT ERROR] in _fat_load_no_cache() : buffer too small : "
4344                "file_size = %x / buffer_size = %x", file_size , buffer_size );
4345        return -3;
4346    }
4347
4348    // compute total number of clusters to read
4349    unsigned int nb_clusters = file_size >> 12;
4350    if ( file_size & 0xFFF ) nb_clusters++;
4351
4352    // initialise buffer address
4353    unsigned int dst = buffer_vbase;
4354
4355    // loop on the clusters containing the file
4356    while ( nb_clusters > 0 )
4357    {
4358        unsigned int lba = _cluster_to_lba( cluster );
4359
4360        if( _fat_ioc_access( 0,         // no descheduling
4361                             1,         // read
4362                             lba, 
4363                             dst, 
4364                             8 ) )      // 8 blocks
4365        {
4366            _printf("\n[FAT ERROR] in _fat_no _cache_read() : cannot load lba %x", lba );
4367            return -4;
4368        }
4369         
4370
4371        // compute next cluster index
4372        unsigned int next;
4373        if ( _next_cluster_no_cache( cluster , &next ) )
4374        {
4375            _printf("\n[FAT ERROR] in _fat_no _cache_read() : cannot get next cluster "
4376                    " for cluster = %x\n", cluster );
4377            return -5;
4378        }
4379       
4380        // update variables for next iteration
4381        nb_clusters = nb_clusters - 1;
4382        dst         = dst + 4096;
4383        cluster     = next;
4384    }
4385         
4386#if GIET_DEBUG_FAT
4387if ( _get_proctime() > GIET_DEBUG_FAT )
4388_printf("\n[DEBUG FAT] _fat_load_no_cache() : P[%d,%d,%d] loaded <%s> at vaddr = %x"
4389        " / size = %x\n", x , y , p , pathname , buffer_vbase , file_size );
4390#endif
4391
4392    return 0;
4393}  // end _fat_load_no_cache()
4394
4395
4396
4397// Local Variables:
4398// tab-width: 4
4399// c-basic-offset: 4
4400// c-file-offsets:((innamespace . 0)(inline-open . 0))
4401// indent-tabs-mode: nil
4402// End:
4403// vim: filetype=c:expandtab:shiftwidth=4:tabstop=4:softtabstop=4
4404
Note: See TracBrowser for help on using the repository browser.