|
| 1 | +use alloc::boxed::Box; |
| 2 | +use core::mem; |
| 3 | +use core::ptr; |
| 4 | +use core::sync::atomic; |
| 5 | + |
| 6 | +use bindings; |
| 7 | +use c_types; |
| 8 | +use error; |
| 9 | +use types; |
| 10 | +use user_ptr::{UserSlicePtr, UserSlicePtrWriter}; |
| 11 | + |
| 12 | +pub struct Sysctl<T: SysctlStorage> { |
| 13 | + inner: Box<T>, |
| 14 | + table: Box<[bindings::ctl_table]>, |
| 15 | + header: *mut bindings::ctl_table_header, |
| 16 | +} |
| 17 | + |
| 18 | +pub trait SysctlStorage: Sync { |
| 19 | + fn store_value(&self, data: &[u8]) -> (usize, error::KernelResult<()>); |
| 20 | + fn read_value(&self, data: &mut UserSlicePtrWriter) -> (usize, error::KernelResult<()>); |
| 21 | +} |
| 22 | + |
| 23 | +fn trim_whitespace(mut data: &[u8]) -> &[u8] { |
| 24 | + while !data.is_empty() && (data[0] == b' ' || data[0] == b'\t' || data[0] == b'\n') { |
| 25 | + data = &data[1..]; |
| 26 | + } |
| 27 | + while !data.is_empty() |
| 28 | + && (data[data.len() - 1] == b' ' |
| 29 | + || data[data.len() - 1] == b'\t' |
| 30 | + || data[data.len() - 1] == b'\n') |
| 31 | + { |
| 32 | + data = &data[..data.len() - 1]; |
| 33 | + } |
| 34 | + return data; |
| 35 | +} |
| 36 | + |
| 37 | +impl SysctlStorage for atomic::AtomicBool { |
| 38 | + fn store_value(&self, data: &[u8]) -> (usize, error::KernelResult<()>) { |
| 39 | + let result = match trim_whitespace(data) { |
| 40 | + b"0" => { |
| 41 | + self.store(false, atomic::Ordering::Relaxed); |
| 42 | + Ok(()) |
| 43 | + } |
| 44 | + b"1" => { |
| 45 | + self.store(true, atomic::Ordering::Relaxed); |
| 46 | + Ok(()) |
| 47 | + } |
| 48 | + _ => Err(error::Error::EINVAL), |
| 49 | + }; |
| 50 | + return (data.len(), result); |
| 51 | + } |
| 52 | + |
| 53 | + fn read_value(&self, data: &mut UserSlicePtrWriter) -> (usize, error::KernelResult<()>) { |
| 54 | + let value = if self.load(atomic::Ordering::Relaxed) { |
| 55 | + b"1\n" |
| 56 | + } else { |
| 57 | + b"0\n" |
| 58 | + }; |
| 59 | + (value.len(), data.write(value)) |
| 60 | + } |
| 61 | +} |
| 62 | + |
| 63 | +unsafe extern "C" fn proc_handler<T: SysctlStorage>( |
| 64 | + ctl: *mut bindings::ctl_table, |
| 65 | + write: c_types::c_int, |
| 66 | + buffer: *mut c_types::c_void, |
| 67 | + len: *mut usize, |
| 68 | + ppos: *mut bindings::loff_t, |
| 69 | +) -> c_types::c_int { |
| 70 | + // If we're reading from some offset other than the beginning of the file, |
| 71 | + // return an empty read to signal EOF. |
| 72 | + if *ppos != 0 && write == 0 { |
| 73 | + *len = 0; |
| 74 | + return 0; |
| 75 | + } |
| 76 | + |
| 77 | + let data = match UserSlicePtr::new(buffer, *len) { |
| 78 | + Ok(ptr) => ptr, |
| 79 | + Err(e) => return e.to_kernel_errno(), |
| 80 | + }; |
| 81 | + let storage = &*((*ctl).data as *const T); |
| 82 | + let (bytes_processed, result) = if write != 0 { |
| 83 | + let data = match data.read_all() { |
| 84 | + Ok(r) => r, |
| 85 | + Err(e) => return e.to_kernel_errno(), |
| 86 | + }; |
| 87 | + storage.store_value(&data) |
| 88 | + } else { |
| 89 | + let mut writer = data.writer(); |
| 90 | + storage.read_value(&mut writer) |
| 91 | + }; |
| 92 | + *len = bytes_processed; |
| 93 | + *ppos += *len as bindings::loff_t; |
| 94 | + match result { |
| 95 | + Ok(()) => 0, |
| 96 | + Err(e) => e.to_kernel_errno(), |
| 97 | + } |
| 98 | +} |
| 99 | + |
| 100 | +impl<T: SysctlStorage> Sysctl<T> { |
| 101 | + pub fn register( |
| 102 | + path: &'static str, |
| 103 | + name: &'static str, |
| 104 | + storage: T, |
| 105 | + mode: types::Mode, |
| 106 | + ) -> error::KernelResult<Sysctl<T>> { |
| 107 | + if !path.ends_with('\x00') || !name.ends_with('\x00') || name.contains('/') { |
| 108 | + return Err(error::Error::EINVAL); |
| 109 | + } |
| 110 | + |
| 111 | + let storage = Box::new(storage); |
| 112 | + let mut table = vec![ |
| 113 | + bindings::ctl_table { |
| 114 | + procname: name.as_ptr() as *const i8, |
| 115 | + mode: mode.as_int(), |
| 116 | + data: &*storage as *const T as *mut c_types::c_void, |
| 117 | + proc_handler: Some(proc_handler::<T>), |
| 118 | + |
| 119 | + maxlen: 0, |
| 120 | + child: ptr::null_mut(), |
| 121 | + poll: ptr::null_mut(), |
| 122 | + extra1: ptr::null_mut(), |
| 123 | + extra2: ptr::null_mut(), |
| 124 | + }, |
| 125 | + unsafe { mem::zeroed() }, |
| 126 | + ].into_boxed_slice(); |
| 127 | + |
| 128 | + let result = |
| 129 | + unsafe { bindings::register_sysctl(path.as_ptr() as *const i8, table.as_mut_ptr()) }; |
| 130 | + if result.is_null() { |
| 131 | + return Err(error::Error::ENOMEM); |
| 132 | + } |
| 133 | + |
| 134 | + return Ok(Sysctl { |
| 135 | + inner: storage, |
| 136 | + table: table, |
| 137 | + header: result, |
| 138 | + }); |
| 139 | + } |
| 140 | + |
| 141 | + pub fn get(&self) -> &T { |
| 142 | + return &self.inner; |
| 143 | + } |
| 144 | +} |
| 145 | + |
| 146 | +impl<T: SysctlStorage> Drop for Sysctl<T> { |
| 147 | + fn drop(&mut self) { |
| 148 | + unsafe { |
| 149 | + bindings::unregister_sysctl_table(self.header); |
| 150 | + } |
| 151 | + self.header = ptr::null_mut(); |
| 152 | + } |
| 153 | +} |
0 commit comments