axplat-dyn 0.5.12

A dynamic platform module for ArceOS, providing runtime platform detection and configuration
Documentation
use ax_driver_base::{BaseDriverOps, DevError, DevResult, DeviceType};
use ax_driver_block::BlockDriverOps;
use rd_block::BlkError;
use rdrive::Device;
use spin::Mutex;

use super::DmaImpl;

#[cfg(feature = "phytium-blk")]
mod phytium;
#[cfg(feature = "sdmmc")]
mod rockchip;
mod virtio;
mod virtio_pci;

pub struct Block {
    dev: Device<rd_block::Block>,
    queue: Mutex<rd_block::CmdQueue>,
}

impl BaseDriverOps for Block {
    fn device_type(&self) -> DeviceType {
        DeviceType::Block
    }

    fn device_name(&self) -> &str {
        self.dev.descriptor().name
    }
}

impl BlockDriverOps for Block {
    fn num_blocks(&self) -> u64 {
        self.queue.lock().num_blocks() as _
    }

    fn block_size(&self) -> usize {
        self.queue.lock().block_size()
    }

    fn flush(&mut self) -> DevResult {
        Ok(())
    }

    fn read_block(&mut self, block_id: u64, buf: &mut [u8]) -> DevResult {
        let blk_count = buf.len() / self.block_size();
        let blocks = self
            .queue
            .lock()
            .read_blocks_blocking(block_id as _, blk_count);
        for (block, chunk) in blocks.into_iter().zip(buf.chunks_mut(self.block_size())) {
            let block = block.map_err(maping_blk_err_to_dev_err)?;
            if block.len() != chunk.len() {
                return Err(DevError::Io);
            }
            chunk.copy_from_slice(&block);
        }
        Ok(())
    }

    fn write_block(&mut self, block_id: u64, buf: &[u8]) -> DevResult {
        let blocks = self.queue.lock().write_blocks_blocking(block_id as _, buf);
        for block in blocks {
            block.map_err(maping_blk_err_to_dev_err)?;
        }
        Ok(())
    }
}

impl From<Device<rd_block::Block>> for Block {
    fn from(base: Device<rd_block::Block>) -> Self {
        let queue = base.lock().unwrap().create_queue().unwrap();
        Self {
            dev: base,
            queue: Mutex::new(queue),
        }
    }
}

pub trait PlatformDeviceBlock {
    fn register_block<T: rd_block::Interface>(self, dev: T);
}

impl PlatformDeviceBlock for rdrive::PlatformDevice {
    fn register_block<T: rd_block::Interface>(self, dev: T) {
        let dev = rd_block::Block::new(dev, &DmaImpl);
        self.register(dev);
    }
}

fn maping_blk_err_to_dev_err(err: BlkError) -> DevError {
    match err {
        BlkError::NotSupported => DevError::Unsupported,
        BlkError::Retry => DevError::Again,
        BlkError::NoMemory => DevError::NoMemory,
        BlkError::InvalidBlockIndex(_) => DevError::InvalidParam,
        BlkError::Other(error) => {
            error!("Block device error: {error}");
            DevError::Io
        }
    }
}