common: Use slice.swap() to clean up SectorHeaderIter::sort().
[gps-watch.git] / src / common / logger.rs
index d83d2391bfe1a6261dc2bb312e2a6a288d26ba16..95f4a4342a1f0320f76a98b26d5909f217442663 100644 (file)
@@ -25,12 +25,21 @@ use gps::TimeAndPos;
 use storage::Storage;
 use varint;
 use systick::elapsed_ms;
+use buffer::Buffer;
+use yencode::Yencode;
+use fmt::*;
+use time::Time;
 
 pub const MEMORY_SIZE: usize = 2 << 20;
 const SECTOR_SIZE: usize = 4 << 10;
 
 const NUM_SECTORS: usize = MEMORY_SIZE / SECTOR_SIZE;
 
+#[derive(Clone, Copy, PartialEq, Debug)]
+pub enum Error {
+    NoSuchRecording,
+}
+
 enum SectorFlag {
     InUse      = 1 << 0,
     DataRecord = 1 << 1,
@@ -72,6 +81,10 @@ impl SectorHeader {
 
         (self.flags & mask) == value
     }
+
+    fn belongs_to(&self, recording_id: u16) -> bool {
+        self.is_in_use() && self.recording_id == recording_id
+    }
 }
 
 #[derive(Clone, Copy)]
@@ -92,7 +105,7 @@ impl InFlight {
 }
 
 pub struct Logger<'a> {
-    storage: &'a mut dyn Storage,
+    pub storage: &'a mut dyn Storage,
 
     recording_id: u16, // Zero is considered invalid.
 
@@ -192,18 +205,7 @@ impl<'a> SectorHeaderIter<'a> {
 
         if num_elts_to_sort != 0 {
             // Sort the used directory entries.
-            for i in (1..((num_elts_to_sort + 1) / 2) + 1).rev() {
-                downheap(&mut iter.indices, i - 1, num_elts_to_sort - 1,
-                         iter.sector_header);
-            }
-
-            for i in (1..num_elts_to_sort).rev() {
-                let t = iter.indices[0];
-                iter.indices[0] = iter.indices[i];
-                iter.indices[i] = t;
-
-                downheap(&mut iter.indices, 0, i - 1, iter.sector_header);
-            }
+            iter.sort(num_elts_to_sort);
         }
 
         // Now put the indices of the unused directory entries in the array.
@@ -242,6 +244,19 @@ impl<'a> SectorHeaderIter<'a> {
 
         iter
     }
+
+    fn sort(&mut self, num_elts_to_sort: usize) {
+        for i in (1..((num_elts_to_sort + 1) / 2) + 1).rev() {
+            downheap(&mut self.indices, i - 1, num_elts_to_sort - 1,
+                     self.sector_header);
+        }
+
+        for i in (1..num_elts_to_sort).rev() {
+            self.indices.swap(0, i);
+
+            downheap(&mut self.indices, 0, i - 1, self.sector_header);
+        }
+    }
 }
 
 impl<'a> Iterator for SectorHeaderIter<'a> {
@@ -329,7 +344,7 @@ impl<'a> Logger<'a> {
 
     fn read_sector_header(&mut self, sector_index: usize) {
         let address = sector_index * SECTOR_SIZE;
-        let mut chunk = [0u8; 4];
+        let mut chunk = [0u8; 8];
 
         self.storage.read(address, &mut chunk);
 
@@ -418,8 +433,10 @@ impl<'a> Logger<'a> {
 
         let this_sector = self.first_sector + self.sectors_written;
 
-        self.storage.write(this_sector as usize * SECTOR_SIZE,
-                           &self.write_buffer);
+        if self.storage.write(this_sector as usize * SECTOR_SIZE,
+                              &self.write_buffer).is_err() {
+            // XXX
+        }
 
         self.sectors_written += 1;
 
@@ -541,8 +558,10 @@ impl<'a> Logger<'a> {
             // our buffer with 0xff, so we don't need to do anything here.
             let this_sector = self.first_sector + self.sectors_written;
 
-            self.storage.write(this_sector as usize * SECTOR_SIZE,
-                               &self.write_buffer);
+            if self.storage.write(this_sector as usize * SECTOR_SIZE,
+                                  &self.write_buffer).is_err() {
+                // XXX
+            }
 
             self.sectors_written += 1;
 
@@ -557,4 +576,108 @@ impl<'a> Logger<'a> {
 
         self.write_buffer_offset += num_bytes_written;
     }
+
+    ///
+    /// Write a listing of the stored recordings to @p tx_buf.
+    pub fn list_recordings(&mut self, tx_buf: &mut Buffer) {
+        for index in self.sector_header_iter().rev() {
+            let sector_header = &self.sector_header[index as usize];
+
+            if !sector_header.starts_recording() {
+                continue;
+            }
+
+            let mut date_time_s = [b' '; 19];
+
+            if let Some(tm) = Time::from_unix_time(sector_header.start_time) {
+                tm.fmt_date(&mut date_time_s[0..]);
+                tm.fmt_time(&mut date_time_s[11..]);
+            }
+
+            let mut recording_id_s = [b'0'; 9];
+            let recording_id_s_len =
+                fmt_u32_pad(&mut recording_id_s,
+                            sector_header.recording_id as u32,
+                            8, b' ');
+
+            tx_buf.write(&date_time_s);
+            tx_buf.write(b"       ");
+            tx_buf.write(&recording_id_s[0..recording_id_s_len]);
+            tx_buf.write(b"\n");
+
+            tx_buf.flush();
+        }
+    }
+
+    ///
+    /// Check whether or not recording @p recording_id exists.
+    pub fn has_recording(&mut self, recording_id: u16) -> bool {
+        if recording_id == 0 {
+            return false;
+        }
+
+        self.sector_header_iter().find(|&index| {
+            let sector_header = &self.sector_header[index as usize];
+
+            sector_header.recording_id == recording_id &&
+            sector_header.starts_recording()
+        }).is_some()
+    }
+
+    ///
+    /// Retrieve recording @p recording_id and
+    /// write it to @p tx_buf in yencoded form.
+    pub fn get_recording(&mut self, recording_id: u16,
+                         tx_buf: &mut Buffer) -> Result<(), Error> {
+        if recording_id == 0 {
+            return Err(Error::NoSuchRecording);
+        }
+
+        if let Some(found_index) = self.sector_header_iter().find(|&index| {
+            let sector_header = &self.sector_header[index as usize];
+
+            sector_header.recording_id == recording_id &&
+            sector_header.starts_recording()
+        }) {
+            let mut filename = [b' '; 29];
+
+            filename[0..].copy_from_slice(b"gps-watch-recording-XXXXX.bin");
+
+            fmt_u32_pad(&mut filename[20..], recording_id as u32, 5, b'0');
+
+            let mut yenc = Yencode::new(tx_buf);
+
+            yenc.start(&filename);
+
+            let format_version = 1u8;
+            yenc.data(&[format_version]);
+
+            let mut next_sector = found_index as usize;
+
+            for _ in 0..NUM_SECTORS {
+                let address = next_sector * SECTOR_SIZE;
+                let mut buf = [0u8; SECTOR_SIZE];
+
+                self.storage.read(address, &mut buf);
+
+                // Skip flags and recording ID.
+                yenc.data(&buf[4..]);
+
+                next_sector += 1;
+                next_sector &= NUM_SECTORS - 1;
+
+                if !self.sector_header[next_sector].belongs_to(recording_id) {
+                    break;
+                }
+            }
+
+            yenc.finish();
+
+            tx_buf.flush();
+
+            Ok(())
+        } else {
+            Err(Error::NoSuchRecording)
+        }
+    }
 }