Add missing semicolon; remove useless test.

[bertos.git] / bertos / fs / battfs.c

diff --git a/bertos/fs/battfs.c b/bertos/fs/battfs.c
index 2f4eee432bb7adce1614aeb07b471935d3af9d65..671a1b91affe88594460b41bd543a2823df4b31b 100644 (file)
--- a/bertos/fs/battfs.c
+++ b/bertos/fs/battfs.c
@@ -508,6 +508,61 @@ bool battfs_init(struct BattFsSuper *disk)
        return true;
 }
 
+/**
+ * Check the filesystem.
+ * \return true if ok, false on errors.
+ */
+bool battfs_fsck(struct BattFsSuper *disk)
+{
+       #define FSCHECK(cond) do { if(!(cond)) { LOG_ERR("\"" #cond "\"\n"); return false; } } while (0)
+
+       FSCHECK(disk->free_page_start <= disk->page_count);
+       FSCHECK(disk->data_size < disk->page_size);
+       FSCHECK(disk->free_bytes <= disk->disk_size);
+
+       disk_size_t free_bytes = 0;
+       BattFsPageHeader hdr, prev_hdr;
+       inode_t files = 0;
+       pgcnt_t page_used = 0;
+
+       bool start = true;
+
+       for (pgcnt_t page = 0; page < disk->page_count; page++)
+       {
+               FSCHECK(readHdr(disk, disk->page_array[page], &hdr));
+               free_bytes += disk->data_size;
+
+               if (page < disk->free_page_start)
+               {
+                       FSCHECK(computeFcs(&hdr) == hdr.fcs);
+                       page_used++;
+                       free_bytes -= hdr.fill;
+                       if (hdr.inode != prev_hdr.inode || start)
+                       {
+                               if (LIKELY(!start))
+                                       FSCHECK(hdr.inode > prev_hdr.inode);
+                               else
+                                       start = false;
+
+                               FSCHECK(hdr.pgoff == 0);
+                               files++;
+                       }
+                       else
+                       {
+                               FSCHECK(hdr.fill != 0);
+                               FSCHECK(prev_hdr.fill == disk->data_size);
+                               FSCHECK(hdr.pgoff == prev_hdr.pgoff + 1);
+                       }
+                       prev_hdr = hdr;
+               }
+       }
+
+       FSCHECK(page_used == disk->free_page_start);
+       FSCHECK(free_bytes == disk->free_bytes);
+
+       return true;
+}
+
 /**
  * Flush file \a fd.
  * \return 0 if ok, EOF on errors.
@@ -613,36 +668,40 @@ static size_t battfs_write(struct KFile *fd, const void *_buf, size_t size)
                        fdb->disk->cache_dirty = true;
                }
                setBufferHdr(fdb->disk, &curr_hdr);
-               flushBuffer(fdb->disk);
-
-               /* Fill page buffer with 0 to avoid filling unused pages with garbage */
-               for (pgaddr_t off = 0; off < fdb->disk->data_size; off++)
-               {
-                       if (fdb->disk->bufferWrite(fdb->disk, off, &dummy, 1) != 1)
-                       {
-                               #warning TODO set error?
-                       }
-               }
 
                /* Allocate the missing pages first. */
                pgoff_t missing_pages = fd->seek_pos / fdb->disk->data_size - fdb->max_off;
-               LOG_INFO("missing pages: %d\n", missing_pages);
 
-               while (missing_pages--)
+               if (missing_pages)
                {
-                       zero_bytes = MIN((kfile_off_t)fdb->disk->data_size, fd->seek_pos - fd->size);
-                       /* Get the new page needed */
-                       if (!getNewPage(fdb->disk, (fdb->start - fdb->disk->page_array) + fdb->max_off + 1, fdb->inode, fdb->max_off + 1, &curr_hdr))
-                               return total_write;
+                       LOG_INFO("missing pages: %d\n", missing_pages);
+                       flushBuffer(fdb->disk);
+
+                       /* Fill page buffer with 0 to avoid filling unused pages with garbage */
+                       for (pgaddr_t off = 0; off < fdb->disk->data_size; off++)
+                       {
+                               if (fdb->disk->bufferWrite(fdb->disk, off, &dummy, 1) != 1)
+                               {
+                                       #warning TODO set error?
+                               }
+                       }
 
-                       /* Update size and free space left */
-                       fd->size += zero_bytes;
-                       fdb->disk->free_bytes -= zero_bytes;
+                       while (missing_pages--)
+                       {
+                               zero_bytes = MIN((kfile_off_t)fdb->disk->data_size, fd->seek_pos - fd->size);
+                               /* Get the new page needed */
+                               if (!getNewPage(fdb->disk, (fdb->start - fdb->disk->page_array) + fdb->max_off + 1, fdb->inode, fdb->max_off + 1, &curr_hdr))
+                                       return total_write;
 
-                       curr_hdr.fill = zero_bytes;
-                       setBufferHdr(fdb->disk, &curr_hdr);
+                               /* Update size and free space left */
+                               fd->size += zero_bytes;
+                               fdb->disk->free_bytes -= zero_bytes;
 
-                       fdb->max_off++;
+                               curr_hdr.fill = zero_bytes;
+                               setBufferHdr(fdb->disk, &curr_hdr);
+
+                               fdb->max_off++;
+                       }
                }
        }
        else if (!getBufferHdr(fdb->disk, &curr_hdr))