|
| 1 | +use crate::{dap, screen, second_stage_end}; |
| 2 | +use core::{fmt::Write as _, slice}; |
| 3 | + |
| 4 | +pub struct DiskAccess { |
| 5 | + pub disk_number: u16, |
| 6 | + pub base_offset: u64, |
| 7 | + pub current_offset: u64, |
| 8 | +} |
| 9 | + |
| 10 | +impl fatfs::IoBase for DiskAccess { |
| 11 | + type Error = (); |
| 12 | +} |
| 13 | + |
| 14 | +impl fatfs::Read for DiskAccess { |
| 15 | + fn read(&mut self, buf: &mut [u8]) -> Result<usize, Self::Error> { |
| 16 | + writeln!(screen::Writer, "read {} bytes", buf.len()).unwrap(); |
| 17 | + |
| 18 | + let end_addr = self.base_offset + self.current_offset + u64::try_from(buf.len()).unwrap(); |
| 19 | + let start_lba = (self.base_offset + self.current_offset) / 512; |
| 20 | + let end_lba = (end_addr - 1) / 512; |
| 21 | + |
| 22 | + let target_addr = u16::try_from(second_stage_end() as usize).unwrap(); |
| 23 | + let dap = dap::DiskAddressPacket::from_lba( |
| 24 | + target_addr, |
| 25 | + start_lba, |
| 26 | + u16::try_from(end_lba + 1 - start_lba).unwrap(), |
| 27 | + ); |
| 28 | + writeln!(screen::Writer, "dap: {dap:?}").unwrap(); |
| 29 | + unsafe { |
| 30 | + dap.perform_load(self.disk_number); |
| 31 | + } |
| 32 | + |
| 33 | + let data = unsafe { slice::from_raw_parts(target_addr as *const u8, buf.len()) }; |
| 34 | + buf.copy_from_slice(data); |
| 35 | + |
| 36 | + self.current_offset = end_addr; |
| 37 | + Ok(buf.len()) |
| 38 | + } |
| 39 | +} |
| 40 | + |
| 41 | +impl fatfs::Seek for DiskAccess { |
| 42 | + fn seek(&mut self, pos: fatfs::SeekFrom) -> Result<u64, Self::Error> { |
| 43 | + writeln!(screen::Writer, "seek to {pos:?}").unwrap(); |
| 44 | + match pos { |
| 45 | + fatfs::SeekFrom::Start(offset) => { |
| 46 | + self.current_offset = offset; |
| 47 | + Ok(self.current_offset) |
| 48 | + } |
| 49 | + fatfs::SeekFrom::Current(offset) => { |
| 50 | + self.current_offset = (i64::try_from(self.current_offset).unwrap() + offset) |
| 51 | + .try_into() |
| 52 | + .unwrap(); |
| 53 | + Ok(self.current_offset) |
| 54 | + } |
| 55 | + fatfs::SeekFrom::End(_) => Err(()), |
| 56 | + } |
| 57 | + } |
| 58 | +} |
| 59 | + |
| 60 | +impl fatfs::Write for DiskAccess { |
| 61 | + fn write(&mut self, buf: &[u8]) -> Result<usize, Self::Error> { |
| 62 | + unimplemented!() |
| 63 | + } |
| 64 | + |
| 65 | + fn flush(&mut self) -> Result<(), Self::Error> { |
| 66 | + unimplemented!() |
| 67 | + } |
| 68 | +} |
0 commit comments