pmhuj4vri/src/sfs.rs

use spin::Mutex;
use bit_set::BitSet;
use alloc::{boxed::Box, Vec, BTreeMap, rc::{Rc, Weak}};
use core::cell::{RefCell, RefMut};
use dirty::Dirty;
use super::structs::*;
use super::vfs;
use core::mem::{uninitialized, size_of};
use core::slice;
use core::fmt::{Debug, Formatter, Error};

/// Interface for SFS to read & write
///     TODO: use std::io::{Read, Write}
pub trait Device {
    fn read_at(&mut self, offset: usize, buf: &mut [u8]) -> Option<usize>;
    fn write_at(&mut self, offset: usize, buf: &[u8]) -> Option<usize>;

    // Helper functions

    fn read_block(&mut self, id: BlockId, offset: usize, buf: &mut [u8]) -> Result<(),()> {
        debug_assert!(offset + buf.len() <= BLKSIZE);
        match self.read_at(id * BLKSIZE + offset, buf) {
            Some(len) if len == buf.len() => Ok(()),
            _ => Err(()),
        }
    }
    fn write_block(&mut self, id: BlockId, offset: usize, buf: &[u8]) -> Result<(),()> {
        debug_assert!(offset + buf.len() <= BLKSIZE);
        match self.write_at(id * BLKSIZE + offset, buf) {
            Some(len) if len == buf.len() => Ok(()),
            _ => Err(()),
        }
    }
}

/// Load struct `T` from given block in device
///     Workaround: It should be inside the trait `Device`. But that would cause compile error.
fn load_struct<T: AsBuf>(device: &mut Device, id: BlockId) -> T {
    let mut s: T = unsafe{ uninitialized() };
    device.read_block(id, 0, s.as_buf_mut()).unwrap();
    s
}

/// inode for sfs
pub struct INode {
    /// on-disk inode
    disk_inode: Dirty<DiskINode>,
    /// inode number
    id: INodeId,
    /// Weak reference to SFS, used by almost all operations
    fs: Weak<RefCell<SimpleFileSystem>>,
}

impl Debug for INode {
    fn fmt(&self, f: &mut Formatter) -> Result<(), Error> {
        write!(f, "{:?}", *self.disk_inode)
    }
}

impl INode {
    /// Map file block id to disk block id
    fn disk_block_id(&self, file_block_id: BlockId) -> Option<BlockId> {
        match file_block_id {
            id if id >= self.disk_inode.blocks as BlockId =>
                None,
            id if id < NDIRECT =>
                Some(self.disk_inode.direct[id] as BlockId),
            id if id < NDIRECT + BLK_NENTRY => {
                let mut disk_block_id: BlockId = 0;
                let fs = self.fs.upgrade().unwrap();
                fs.borrow_mut().device.read_block(
                    self.disk_inode.indirect as usize,
                    ENTRY_SIZE * (id - NDIRECT),
                    disk_block_id.as_buf_mut()
                ).unwrap();
                Some(disk_block_id as BlockId)
            },
            id => unimplemented!("double indirect blocks is not supported"),
        }
    }
}

impl vfs::INode for INode {
    fn open(&mut self, flags: u32) -> Result<(), ()> {
        // Do nothing
        Ok(())
    }
    fn close(&mut self) -> Result<(), ()> {
        self.sync()
    }
    fn read_at(&mut self, offset: usize, buf: &mut [u8]) -> Option<usize> {
        let fs0 = self.fs.upgrade().unwrap();
        let mut fs = fs0.borrow_mut();

        let iter = BlockIter {
            begin: offset,
            end: offset + buf.len(),
        };

        // Read for each block
        let mut buf_offset = 0usize;
        for BlockRange{block, begin, end} in iter {
            if let Some(disk_block_id) = self.disk_block_id(block) {
                let len = end - begin;
                fs.device.read_block(disk_block_id, begin, &mut buf[buf_offset .. buf_offset + len]);
                buf_offset += len;
            } else {
                // Failed this time
                break;
            }
        }
        Some(buf_offset)
    }
    fn write_at(&mut self, offset: usize, buf: &[u8]) -> Option<usize> {
        let fs0 = self.fs.upgrade().unwrap();
        let mut fs = fs0.borrow_mut();

        let iter = BlockIter {
            begin: offset,
            end: offset + buf.len(),
        };

        // Read for each block
        let mut buf_offset = 0usize;
        for BlockRange{block, begin, end} in iter {
            if let Some(disk_block_id) = self.disk_block_id(block) {
                let len = end - begin;
                fs.device.write_block(disk_block_id, begin, &buf[buf_offset .. buf_offset + len]);
                buf_offset += len;
            } else {
                // Failed this time
                break;
            }
        }
        Some(buf_offset)
    }
    fn sync(&mut self) -> Result<(), ()> {
        if self.disk_inode.dirty() {
            let fs0 = self.fs.upgrade().unwrap();
            let mut fs = fs0.borrow_mut();
            fs.device.write_block(self.id, 0, self.disk_inode.as_buf())?;
            self.disk_inode.sync();
        }
        Ok(())
    }
}

/// Given a range and iterate sub-range for each block
struct BlockIter {
    begin: usize,
    end: usize,
}

struct BlockRange {
    block: BlockId,
    begin: usize,
    end: usize,
}

impl Iterator for BlockIter {
    type Item = BlockRange;

    fn next(&mut self) -> Option<<Self as Iterator>::Item> {
        if self.begin >= self.end {
            return None;
        }
        let block = self.begin / BLKSIZE;
        let begin = self.begin % BLKSIZE;
        let end = if block == self.end / BLKSIZE {self.end % BLKSIZE} else {BLKSIZE};
        self.begin += end - begin;
        Some(BlockRange {block, begin, end})
    }
}


/// filesystem for sfs
pub struct SimpleFileSystem {
    /// on-disk superblock
    super_block: Dirty<SuperBlock>,
    /// blocks in use are mared 0
    free_map: BitSet,
    /// inode list
    inodes: BTreeMap<INodeId, Rc<INode>>,
    /// device
    device: Box<Device>,
    /// Pointer to self, used by INodes
    self_ptr: Weak<RefCell<SimpleFileSystem>>,
}

impl SimpleFileSystem {
    /// Create a new SFS with device
    pub fn new(mut device: Box<Device>) -> Option<Rc<RefCell<Self>>> {
        let super_block = load_struct::<SuperBlock>(device.as_mut(), BLKN_SUPER);
        if super_block.check() == false {
            return None;
        }

        let mut fs = Rc::new(RefCell::new(SimpleFileSystem {
            super_block: Dirty::new(super_block),
            free_map: BitSet::new(),
            inodes: BTreeMap::<INodeId, Rc<INode>>::new(),
            device,
            self_ptr: Weak::default(),
        }));
        fs.borrow_mut().self_ptr = Rc::downgrade(&fs);

        Some(fs)
    }
    /// Allocate a block, return block id
    fn alloc_block(&mut self) -> Option<usize> {
        let id = self.free_map.alloc();
        if id.is_some() {
            self.super_block.unused_blocks -= 1;    // will panic if underflow
        }
        id
    }
    /// Free a block
    fn free_block(&mut self, block_id: usize) {
        assert!(!self.free_map.contains(block_id));
        self.free_map.insert(block_id);
        self.super_block.unused_blocks += 1;
    }

    /// Get inode by id. Load if not in memory.
    /// ** Must ensure it's a valid INode **
    fn get_inode(&mut self, id: INodeId) -> Rc<INode> {
        assert!(!self.free_map.contains(id));

        // Load if not in memory.
        if !self.inodes.contains_key(&id) {
            let disk_inode = load_struct::<DiskINode>(self.device.as_mut(), id);
            let inode = Rc::new(INode {
                disk_inode: Dirty::new(disk_inode),
                id,
                fs: self.self_ptr.clone(),
            });
            self.inodes.insert(id, inode.clone());
            inode
        } else {
            self.inodes.get(&id).unwrap().clone()
        }
    }
}

impl vfs::FileSystem for SimpleFileSystem {
    type INode = INode;

    /// Write back super block if dirty
    fn sync(&mut self) -> Result<(), ()> {
        let SimpleFileSystem {
            ref mut super_block,
            ref mut device,
            ..
        } = self;

        if super_block.dirty() {
            device.write_at(0, super_block.as_buf());
            super_block.sync();
        }
        Ok(())
    }

    fn root_inode(&mut self) -> Rc<INode> {
        self.get_inode(BLKN_ROOT)
    }

    fn unmount(&mut self) -> Result<(), ()> {
        unimplemented!()
    }

    fn cleanup(&mut self) {
        unimplemented!()
    }
}

trait BitsetAlloc {
    fn alloc(&mut self) -> Option<usize>;
}

impl BitsetAlloc for BitSet {
    fn alloc(&mut self) -> Option<usize> {
        // TODO: more efficient
        let id = (0 .. self.len()).find(|&i| self.contains(i));
        if let Some(id) = id {
            self.remove(id);
        }
        id
    }
}

#[cfg(test)]
mod test {
    use super::*;
}