1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
extern crate libc;
use std::ffi::CString;
use std::io::{Error, ErrorKind};
use std::sync::atomic::{AtomicI32, Ordering};
use std::{cmp, process, ptr, slice};

/// A unique identifier used to create shared memory mapped files.
static BUFFER_ID: AtomicI32 = AtomicI32::new(0);

/// A raw circular buffer of bytes. The buffer holds exactly `size` many
/// bytes, and any at most `wrap` many bytes can be accessed as a continuos
/// slice where the end wraps over to the beginning. This trick is performed
/// with virtual memory, the same physical pages are mapped both at the start
/// and after the end of the buffer.
pub struct Buffer {
    ptr: *const u8,
    size: usize,
    wrap: usize,
}

fn os_error(message: &'static str) -> Error {
    let kind = Error::last_os_error().kind();
    Error::new(kind, message)
}

impl Buffer {
    /// Returns the page size of the underlying operating system.
    pub fn page_size() -> Result<usize, Error> {
        let page = unsafe { libc::sysconf(libc::_SC_PAGESIZE) };
        if page <= 0 {
            Err(os_error("page_size failed"))
        } else {
            Ok(page as usize)
        }
    }

    /// Creates a new circular buffer with the given `size` and `wrap`. The
    /// returned `size` and `wrap` will be rounded up to an integer multiple
    /// of the page size. The `wrap` value cannot be larger than `size`, and
    /// both can be zero to get the page size.
    pub fn new(mut size: usize, mut wrap: usize) -> Result<Buffer, Error> {
        let page = Buffer::page_size()?;

        // round up to a multiple of the page size, be safe
        size = cmp::max(size, page);
        size = ((size + page - 1) / page) * page;
        wrap = cmp::max(wrap, page);
        wrap = ((wrap + page - 1) / page) * page;
        if size + wrap > libc::off_t::max_value() as usize {
            return Err(Error::new(ErrorKind::Other, "invalid sizes"));
        }

        // create temporary shared memory file
        let name = CString::new(format!(
            "/rust-vmcircbuf-{}-{}",
            process::id(),
            BUFFER_ID.fetch_add(1, Ordering::Relaxed)
        ))?;
        let file_desc = unsafe {
            libc::shm_open(
                name.as_ptr(),
                libc::O_RDWR | libc::O_CREAT | libc::O_EXCL,
                0o600,
            )
        };
        if file_desc < 0 {
            return Err(os_error("shm_open failed"));
        }

        // truncate the file to size + wrap
        let ret = unsafe { libc::ftruncate(file_desc, (size + wrap) as libc::off_t) };
        if ret != 0 {
            let ret = os_error("first ftruncate failed");
            unsafe { libc::close(file_desc) };
            return Err(ret);
        }

        // map with it fully
        let first_copy = unsafe {
            libc::mmap(
                ptr::null_mut(),
                size + wrap,
                libc::PROT_READ | libc::PROT_WRITE,
                libc::MAP_SHARED,
                file_desc,
                0,
            )
        };
        if first_copy == libc::MAP_FAILED {
            let ret = os_error("first mmap failed");
            unsafe { libc::close(file_desc) };
            return Err(ret);
        }

        // unmap the second wrap half
        let ret = unsafe { libc::munmap(first_copy.add(size), wrap) };
        if ret != 0 {
            let ret = os_error("munmap failed");
            unsafe { libc::close(file_desc) };
            return Err(ret);
        }

        // memory map the wrap part again
        let second_copy = unsafe {
            libc::mmap(
                first_copy.add(size),
                wrap,
                libc::PROT_READ | libc::PROT_WRITE,
                libc::MAP_SHARED,
                file_desc,
                0,
            )
        };
        if second_copy == libc::MAP_FAILED {
            let ret = os_error("second mmap failed");
            unsafe { libc::close(file_desc) };
            return Err(ret);
        } else if second_copy != unsafe { first_copy.add(size) } {
            unsafe { libc::close(file_desc) };
            return Err(Error::new(ErrorKind::Other, "bad second address"));
        }

        // close the file descriptor
        let ret = unsafe { libc::close(file_desc) };
        if ret != 0 {
            return Err(os_error("close failed"));
        }

        // unlink the shared memory
        let ret = unsafe { libc::shm_unlink(name.as_ptr()) };
        if ret != 0 {
            return Err(os_error("shm_unlink failed"));
        }

        Ok(Buffer {
            ptr: first_copy as *const u8,
            size,
            wrap,
        })
    }

    /// Returns the size of the circular buffer.
    #[inline(always)]
    pub fn size(&self) -> usize {
        self.size
    }

    /// Returns the wrap of the circular buffer.
    #[inline(always)]
    pub fn wrap(&self) -> usize {
        self.wrap
    }

    /// Returns an immutable slice of the circular buffer starting at `start`
    /// and containing `count` many elements. Note, that `start + count`
    /// cannot be larger than `size + wrap`. If `start + count` is bigger
    /// than `size`, then the returned slice will magically wrap over
    /// to the beginning of the buffer.
    #[inline(always)]
    pub fn slice(&self, start: usize, count: usize) -> &[u8] {
        assert!(start + count <= self.size + self.wrap);
        unsafe { self.slice_unchecked(start, count) }
    }

    /// This is the mutable analog of the `slice` method.
    #[inline(always)]
    pub fn slice_mut(&mut self, start: usize, count: usize) -> &mut [u8] {
        assert!(start + count <= self.size + self.wrap);
        unsafe { self.slice_mut_unchecked(start, count) }
    }

    /// This is the unsafe version of the `slice` method.
    /// # Safety
    /// Make sure that `start + count <= size + wrap` before
    /// calling this method.
    #[inline(always)]
    pub unsafe fn slice_unchecked(&self, start: usize, count: usize) -> &[u8] {
        slice::from_raw_parts(self.ptr.add(start), count)
    }

    /// This is the unsafe version of the `slice_mut` method.
    /// # Safety
    /// Make sure that `start + count <= size + wrap` before
    /// calling this method.
    #[inline(always)]
    pub unsafe fn slice_mut_unchecked(&mut self, start: usize, count: usize) -> &mut [u8] {
        slice::from_raw_parts_mut(self.ptr.add(start) as *mut u8, count)
    }
}

impl Drop for Buffer {
    fn drop(&mut self) {
        let ptr = self.ptr as *mut libc::c_void;
        let ret = unsafe { libc::munmap(ptr, 2 * self.size) };
        assert_eq!(ret, 0);
    }
}

unsafe impl Send for Buffer {}
unsafe impl Sync for Buffer {}

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

    #[test]
    fn wrap() {
        let page = Buffer::page_size().unwrap();
        println!("page size: {}", page);
        let mut buffer = Buffer::new(2 * page, page).unwrap();
        let size = buffer.size();
        println!("buffer size: {}, wrap: {}", size, buffer.wrap());

        for (i, a) in buffer.slice_mut(0, size).iter_mut().enumerate() {
            *a = i as u8;
        }
        for (i, a) in buffer.slice(10, size).iter().enumerate() {
            assert_eq!(*a, ((i + 10) % size) as u8);
        }
    }
}