at v6.14 6.2 kB view raw
1// SPDX-License-Identifier: GPL-2.0 2 3// Copyright (C) 2024 Google LLC. 4 5//! Rust misc device sample. 6 7/// Below is an example userspace C program that exercises this sample's functionality. 8/// 9/// ```c 10/// #include <stdio.h> 11/// #include <stdlib.h> 12/// #include <errno.h> 13/// #include <fcntl.h> 14/// #include <unistd.h> 15/// #include <sys/ioctl.h> 16/// 17/// #define RUST_MISC_DEV_FAIL _IO('|', 0) 18/// #define RUST_MISC_DEV_HELLO _IO('|', 0x80) 19/// #define RUST_MISC_DEV_GET_VALUE _IOR('|', 0x81, int) 20/// #define RUST_MISC_DEV_SET_VALUE _IOW('|', 0x82, int) 21/// 22/// int main() { 23/// int value, new_value; 24/// int fd, ret; 25/// 26/// // Open the device file 27/// printf("Opening /dev/rust-misc-device for reading and writing\n"); 28/// fd = open("/dev/rust-misc-device", O_RDWR); 29/// if (fd < 0) { 30/// perror("open"); 31/// return errno; 32/// } 33/// 34/// // Make call into driver to say "hello" 35/// printf("Calling Hello\n"); 36/// ret = ioctl(fd, RUST_MISC_DEV_HELLO, NULL); 37/// if (ret < 0) { 38/// perror("ioctl: Failed to call into Hello"); 39/// close(fd); 40/// return errno; 41/// } 42/// 43/// // Get initial value 44/// printf("Fetching initial value\n"); 45/// ret = ioctl(fd, RUST_MISC_DEV_GET_VALUE, &value); 46/// if (ret < 0) { 47/// perror("ioctl: Failed to fetch the initial value"); 48/// close(fd); 49/// return errno; 50/// } 51/// 52/// value++; 53/// 54/// // Set value to something different 55/// printf("Submitting new value (%d)\n", value); 56/// ret = ioctl(fd, RUST_MISC_DEV_SET_VALUE, &value); 57/// if (ret < 0) { 58/// perror("ioctl: Failed to submit new value"); 59/// close(fd); 60/// return errno; 61/// } 62/// 63/// // Ensure new value was applied 64/// printf("Fetching new value\n"); 65/// ret = ioctl(fd, RUST_MISC_DEV_GET_VALUE, &new_value); 66/// if (ret < 0) { 67/// perror("ioctl: Failed to fetch the new value"); 68/// close(fd); 69/// return errno; 70/// } 71/// 72/// if (value != new_value) { 73/// printf("Failed: Committed and retrieved values are different (%d - %d)\n", value, new_value); 74/// close(fd); 75/// return -1; 76/// } 77/// 78/// // Call the unsuccessful ioctl 79/// printf("Attempting to call in to an non-existent IOCTL\n"); 80/// ret = ioctl(fd, RUST_MISC_DEV_FAIL, NULL); 81/// if (ret < 0) { 82/// perror("ioctl: Succeeded to fail - this was expected"); 83/// } else { 84/// printf("ioctl: Failed to fail\n"); 85/// close(fd); 86/// return -1; 87/// } 88/// 89/// // Close the device file 90/// printf("Closing /dev/rust-misc-device\n"); 91/// close(fd); 92/// 93/// printf("Success\n"); 94/// return 0; 95/// } 96/// ``` 97use core::pin::Pin; 98 99use kernel::{ 100 c_str, 101 device::Device, 102 fs::File, 103 ioctl::{_IO, _IOC_SIZE, _IOR, _IOW}, 104 miscdevice::{MiscDevice, MiscDeviceOptions, MiscDeviceRegistration}, 105 new_mutex, 106 prelude::*, 107 sync::Mutex, 108 types::ARef, 109 uaccess::{UserSlice, UserSliceReader, UserSliceWriter}, 110}; 111 112const RUST_MISC_DEV_HELLO: u32 = _IO('|' as u32, 0x80); 113const RUST_MISC_DEV_GET_VALUE: u32 = _IOR::<i32>('|' as u32, 0x81); 114const RUST_MISC_DEV_SET_VALUE: u32 = _IOW::<i32>('|' as u32, 0x82); 115 116module! { 117 type: RustMiscDeviceModule, 118 name: "rust_misc_device", 119 author: "Lee Jones", 120 description: "Rust misc device sample", 121 license: "GPL", 122} 123 124#[pin_data] 125struct RustMiscDeviceModule { 126 #[pin] 127 _miscdev: MiscDeviceRegistration<RustMiscDevice>, 128} 129 130impl kernel::InPlaceModule for RustMiscDeviceModule { 131 fn init(_module: &'static ThisModule) -> impl PinInit<Self, Error> { 132 pr_info!("Initialising Rust Misc Device Sample\n"); 133 134 let options = MiscDeviceOptions { 135 name: c_str!("rust-misc-device"), 136 }; 137 138 try_pin_init!(Self { 139 _miscdev <- MiscDeviceRegistration::register(options), 140 }) 141 } 142} 143 144struct Inner { 145 value: i32, 146} 147 148#[pin_data(PinnedDrop)] 149struct RustMiscDevice { 150 #[pin] 151 inner: Mutex<Inner>, 152 dev: ARef<Device>, 153} 154 155#[vtable] 156impl MiscDevice for RustMiscDevice { 157 type Ptr = Pin<KBox<Self>>; 158 159 fn open(_file: &File, misc: &MiscDeviceRegistration<Self>) -> Result<Pin<KBox<Self>>> { 160 let dev = ARef::from(misc.device()); 161 162 dev_info!(dev, "Opening Rust Misc Device Sample\n"); 163 164 KBox::try_pin_init( 165 try_pin_init! { 166 RustMiscDevice { 167 inner <- new_mutex!( Inner{ value: 0_i32 } ), 168 dev: dev, 169 } 170 }, 171 GFP_KERNEL, 172 ) 173 } 174 175 fn ioctl(me: Pin<&RustMiscDevice>, _file: &File, cmd: u32, arg: usize) -> Result<isize> { 176 dev_info!(me.dev, "IOCTLing Rust Misc Device Sample\n"); 177 178 let size = _IOC_SIZE(cmd); 179 180 match cmd { 181 RUST_MISC_DEV_GET_VALUE => me.get_value(UserSlice::new(arg, size).writer())?, 182 RUST_MISC_DEV_SET_VALUE => me.set_value(UserSlice::new(arg, size).reader())?, 183 RUST_MISC_DEV_HELLO => me.hello()?, 184 _ => { 185 dev_err!(me.dev, "-> IOCTL not recognised: {}\n", cmd); 186 return Err(ENOTTY); 187 } 188 }; 189 190 Ok(0) 191 } 192} 193 194#[pinned_drop] 195impl PinnedDrop for RustMiscDevice { 196 fn drop(self: Pin<&mut Self>) { 197 dev_info!(self.dev, "Exiting the Rust Misc Device Sample\n"); 198 } 199} 200 201impl RustMiscDevice { 202 fn set_value(&self, mut reader: UserSliceReader) -> Result<isize> { 203 let new_value = reader.read::<i32>()?; 204 let mut guard = self.inner.lock(); 205 206 dev_info!( 207 self.dev, 208 "-> Copying data from userspace (value: {})\n", 209 new_value 210 ); 211 212 guard.value = new_value; 213 Ok(0) 214 } 215 216 fn get_value(&self, mut writer: UserSliceWriter) -> Result<isize> { 217 let guard = self.inner.lock(); 218 let value = guard.value; 219 220 // Free-up the lock and use our locally cached instance from here 221 drop(guard); 222 223 dev_info!( 224 self.dev, 225 "-> Copying data to userspace (value: {})\n", 226 &value 227 ); 228 229 writer.write::<i32>(&value)?; 230 Ok(0) 231 } 232 233 fn hello(&self) -> Result<isize> { 234 dev_info!(self.dev, "-> Hello from the Rust Misc Device\n"); 235 236 Ok(0) 237 } 238}