use crate::{
alloc::{Allocator, Flags},
bindings,
dma::Coherent,
error::Result,
ffi::{c_char, c_void},
fs::file,
prelude::*,
ptr::KnownSize,
transmute::{AsBytes, FromBytes},
};
use core::mem::{size_of, MaybeUninit};
#[repr(transparent)]
#[derive(Copy, Clone)]
pub struct UserPtr(*mut c_void);
impl UserPtr {
#[inline]
pub fn from_addr(addr: usize) -> Self {
Self(addr as *mut c_void)
}
#[inline]
pub fn from_ptr(addr: *mut c_void) -> Self {
Self(addr)
}
#[inline]
pub fn as_const_ptr(self) -> *const c_void {
self.0
}
#[inline]
pub fn as_mut_ptr(self) -> *mut c_void {
self.0
}
#[inline]
pub fn wrapping_byte_add(self, add: usize) -> UserPtr {
UserPtr(self.0.wrapping_byte_add(add))
}
}
pub struct UserSlice {
ptr: UserPtr,
length: usize,
}
impl UserSlice {
pub fn new(ptr: UserPtr, length: usize) -> Self {
UserSlice { ptr, length }
}
pub fn read_all<A: Allocator>(self, buf: &mut Vec<u8, A>, flags: Flags) -> Result {
self.reader().read_all(buf, flags)
}
pub fn reader(self) -> UserSliceReader {
UserSliceReader {
ptr: self.ptr,
length: self.length,
}
}
pub fn writer(self) -> UserSliceWriter {
UserSliceWriter {
ptr: self.ptr,
length: self.length,
}
}
pub fn reader_writer(self) -> (UserSliceReader, UserSliceWriter) {
(
UserSliceReader {
ptr: self.ptr,
length: self.length,
},
UserSliceWriter {
ptr: self.ptr,
length: self.length,
},
)
}
}
pub struct UserSliceReader {
ptr: UserPtr,
length: usize,
}
impl UserSliceReader {
pub fn skip(&mut self, num_skip: usize) -> Result {
self.length = self.length.checked_sub(num_skip).ok_or(EFAULT)?;
self.ptr = self.ptr.wrapping_byte_add(num_skip);
Ok(())
}
pub fn clone_reader(&self) -> UserSliceReader {
UserSliceReader {
ptr: self.ptr,
length: self.length,
}
}
pub fn len(&self) -> usize {
self.length
}
pub fn is_empty(&self) -> bool {
self.length == 0
}
pub fn read_raw(&mut self, out: &mut [MaybeUninit<u8>]) -> Result {
let len = out.len();
let out_ptr = out.as_mut_ptr().cast::<c_void>();
if len > self.length {
return Err(EFAULT);
}
let res = unsafe { bindings::copy_from_user(out_ptr, self.ptr.as_const_ptr(), len) };
if res != 0 {
return Err(EFAULT);
}
self.ptr = self.ptr.wrapping_byte_add(len);
self.length -= len;
Ok(())
}
pub fn read_slice(&mut self, out: &mut [u8]) -> Result {
let out = unsafe { &mut *(core::ptr::from_mut(out) as *mut [MaybeUninit<u8>]) };
self.read_raw(out)
}
pub fn read_slice_partial(&mut self, out: &mut [u8], offset: usize) -> Result<usize> {
let end = offset.saturating_add(self.len()).min(out.len());
let Some(dst) = out.get_mut(offset..end) else {
return Ok(0);
};
self.read_slice(dst)?;
Ok(dst.len())
}
pub fn read_slice_file(&mut self, out: &mut [u8], offset: &mut file::Offset) -> Result<usize> {
if offset.is_negative() {
return Err(EINVAL);
}
let Ok(offset_index) = (*offset).try_into() else {
return Ok(0);
};
let read = self.read_slice_partial(out, offset_index)?;
*offset += read as i64;
Ok(read)
}
pub fn read<T: FromBytes>(&mut self) -> Result<T> {
let len = size_of::<T>();
if len > self.length {
return Err(EFAULT);
}
let mut out: MaybeUninit<T> = MaybeUninit::uninit();
let res = unsafe {
bindings::_copy_from_user(
out.as_mut_ptr().cast::<c_void>(),
self.ptr.as_const_ptr(),
len,
)
};
if res != 0 {
return Err(EFAULT);
}
self.ptr = self.ptr.wrapping_byte_add(len);
self.length -= len;
Ok(unsafe { out.assume_init() })
}
pub fn read_all<A: Allocator>(mut self, buf: &mut Vec<u8, A>, flags: Flags) -> Result {
let len = self.length;
buf.reserve(len, flags)?;
self.read_raw(&mut buf.spare_capacity_mut()[..len])?;
unsafe { buf.inc_len(len) };
Ok(())
}
#[doc(alias = "strncpy_from_user")]
pub fn strcpy_into_buf<'buf>(self, buf: &'buf mut [u8]) -> Result<&'buf CStr> {
if buf.is_empty() {
return Err(EINVAL);
}
let mut dst = unsafe { &mut *(core::ptr::from_mut(buf) as *mut [MaybeUninit<u8>]) };
if dst.len() > self.length {
dst = &mut dst[..self.length];
}
let mut len = raw_strncpy_from_user(dst, self.ptr)?;
if len < dst.len() {
len += 1;
} else if len < buf.len() {
return Err(EFAULT);
} else {
unsafe { *buf.last_mut().unwrap_unchecked() = 0 };
}
Ok(unsafe { CStr::from_bytes_with_nul_unchecked(&buf[..len]) })
}
}
pub struct UserSliceWriter {
ptr: UserPtr,
length: usize,
}
impl UserSliceWriter {
pub fn len(&self) -> usize {
self.length
}
pub fn is_empty(&self) -> bool {
self.length == 0
}
unsafe fn write_raw(&mut self, from: *const u8, len: usize) -> Result {
if len > self.length {
return Err(EFAULT);
}
let res = unsafe { bindings::copy_to_user(self.ptr.as_mut_ptr(), from.cast(), len) };
if res != 0 {
return Err(EFAULT);
}
self.ptr = self.ptr.wrapping_byte_add(len);
self.length -= len;
Ok(())
}
pub fn write_slice(&mut self, data: &[u8]) -> Result {
unsafe { self.write_raw(data.as_ptr(), data.len()) }
}
pub fn write_dma<T: KnownSize + AsBytes + ?Sized>(
&mut self,
alloc: &Coherent<T>,
offset: usize,
count: usize,
) -> Result {
let len = alloc.size();
if offset.checked_add(count).ok_or(EOVERFLOW)? > len {
return Err(ERANGE);
}
if count > self.len() {
return Err(ERANGE);
}
let src_ptr = unsafe { alloc.as_ptr().cast::<u8>().add(offset) };
unsafe { self.write_raw(src_ptr, count) }
}
pub fn write_slice_partial(&mut self, data: &[u8], offset: usize) -> Result<usize> {
let end = offset.saturating_add(self.len()).min(data.len());
let Some(src) = data.get(offset..end) else {
return Ok(0);
};
self.write_slice(src)?;
Ok(src.len())
}
pub fn write_slice_file(&mut self, data: &[u8], offset: &mut file::Offset) -> Result<usize> {
if offset.is_negative() {
return Err(EINVAL);
}
let Ok(offset_index) = (*offset).try_into() else {
return Ok(0);
};
let written = self.write_slice_partial(data, offset_index)?;
*offset += written as i64;
Ok(written)
}
pub fn write<T: AsBytes>(&mut self, value: &T) -> Result {
let len = size_of::<T>();
if len > self.length {
return Err(EFAULT);
}
let res = unsafe {
bindings::_copy_to_user(
self.ptr.as_mut_ptr(),
core::ptr::from_ref(value).cast::<c_void>(),
len,
)
};
if res != 0 {
return Err(EFAULT);
}
self.ptr = self.ptr.wrapping_byte_add(len);
self.length -= len;
Ok(())
}
}
#[inline]
fn raw_strncpy_from_user(dst: &mut [MaybeUninit<u8>], src: UserPtr) -> Result<usize> {
let len = dst.len() as isize;
let res = unsafe {
bindings::strncpy_from_user(
dst.as_mut_ptr().cast::<c_char>(),
src.as_const_ptr().cast::<c_char>(),
len,
)
};
if res < 0 {
return Err(Error::from_errno(res as i32));
}
#[cfg(CONFIG_RUST_OVERFLOW_CHECKS)]
assert!(res <= len);
Ok(res as usize)
}