From mboxrd@z Thu Jan 1 00:00:00 1970 Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.remote-ip=209.85.128.47 ARC-Seal: i=1; d=subspace.kernel.org; s=arc20261015; a=rsa-sha256; cv=none; t=1794001427; b=kIPWa9BectQ1q4Fjuxp6IHQ8QLIFbfsFD0gKV4k+xj80OK9wouuY28GAiNLG1qeic5Xj 2Lkon8uXrArH0NY42iqvA54dQKwSlWbbBrgvOIoOF03t0B/cAXzvcBUIDDQT7cvKVGGzG /wzuc5HID3SmjEAyUQZVkHkShl85Gu2oEZ/Inrtcc+rsILUGSz3KKNi+hm6KmmH7kYEoA F9TXAJcgKV/Up6LHkCKLoc/laRE1b3CopUML5xMZduwlbDUXntff0DPew6+v/2UCKW4Ps UfyBrJ1kXSQUfibFrQf1zrFjtPsxnZ/7Pyxbufhgzk4OcR9x2l8pQmuSCu6HgNVx/qg== ARC-Message-Signature: i=1; d=subspace.kernel.org; s=arc20261015; a=rsa-sha256; c=relaxed/relaxed; t=1794001427; h=DMARC-Filter:Received:DKIM-Signature:X-Google-DKIM-Signature: X-Forwarded-Encrypted:X-Gm-Message-State:X-Gm-Gg:X-Received:Received: From:To:Cc:Subject:Date:Message-ID:X-Mailer:In-Reply-To:References: MIME-Version:Content-Transfer-Encoding; bh=pkIev0+5VFnHK3w1HzmTwW2W40hHaWbBN53mAEIM5hA=; b=BY6LMbHO2qWi2aHRRjfi2C2x3QbfmM6M6xBVGYbsVsZkZNS6GgE9CieUuwoD52SQyZk7 0bI6a3ukL0kqOmMTAcJIRvcAlqm3glTGHS1kwB3hgM9g0A2rrUcIbOk6683t2xAprOCda eP3rjeR8hKNsUGUU7676FMcKeT6B/BeYbzIc5ofkzWVb/5VgjyoUTTLpCGprzPo3PgItu F8WZNTWePjREaDFw905KKEGebrofyuS1PxOHotcMUHMyfB+ztyq5V/owtAuDH5RLBejnV zHmoPJ/T9tamzp0GWHRZgVEpd9JguaCoLHRukltON9AyMVD6O7ZyaSel7f0rqDjkyIw== ARC-Authentication-Results: i=1; smtp.subspace.kernel.org; dmarc=pass header.from=gmail.com; spf=pass smtp.mailfrom=gmail.com; dkim=pass header.d=gmail.com header.i=@gmail.com header.a=rsa-sha256 header.s=20260707 header.b=yD2dKxo5; arc=none smtp.remote-ip=209.85.128.47 Received: from mail-wm1-f47.google.com (mail-wm1-f47.google.com [209.85.128.47]) (using TLSv1.3 with cipher TLS_AES_128_GCM_SHA256 (128/128 bits) key-exchange X25519 server-signature ECDSA (prime256v1) server-digest SHA256) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 49432606A32C for ; Fri, 6 Nov 2026 21:43:46 +0000 (UTC) DMARC-Filter: OpenDMARC Filter v1.4.2 smtp.subspace.kernel.org 49432606A32C Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=gmail.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=gmail.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key, unprotected) header.d=gmail.com header.i=@gmail.com header.a=rsa-sha256 header.s=20260707 header.b=yD2dKxo5 Received: by mail-wm1-f47.google.com with SMTP id 5b1f17b1804b1-4a20bdaf39cso12232205e9.1 for ; Fri, 06 Nov 2026 13:43:46 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20260707; t=1794001425; x=1794606225; darn=vger.kernel.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to:content-type; bh=pkIev0+5VFnHK3w1HzmTwW2W40hHaWbBN53mAEIM5hA=; b=yD2dKxo5fCpMINtpG83sZtJPozVM/v0YjUIhGqL7cEQKuVXn0aoAPwJS0T9GPuB/ay D1twfcaxDDvGOUvQOM8pbFXz5yWq1XidJKZZKeCwlDaNcXUJ9dsnZ9AZvbaRhUDZVIEJ TK0XXjjDxnTJFxwYUEwkMK/ovRl47nB5JuMtVUY5F2Tit4WKo1KnvykRWjlSVyOY+ejU oLuLaq4V4JuNty7WU89zclF8pwwtNUUsemAH1BKdkgDHq+jFg2NBLKAJiGtNiGuTlC8J n6Enf5y0oWUI2zmRuAiUIdQMNQaHQiZftEIa6kysbLEdo7vL1G3nVd5J5DvObObzmuS5 MRcA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20260707; t=1794001425; x=1794606225; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-gg:x-gm-message-state:from :to:cc:subject:date:message-id:reply-to:content-type; bh=pkIev0+5VFnHK3w1HzmTwW2W40hHaWbBN53mAEIM5hA=; b=R0BKUqhW8b4zV6N28kz2vubH3RPRgsuaJrn8L9StUqJsH15TqIXB6Ne3F3OdQdtEYP HUUuavw3Lpt3lvAYMzKeGTSoSW24YGtBs9B8YQYO0R5gQybusJVrcK5eqWOV9G5T3utJ cM7c87VHvnD2kG6H8roWmMRcQtF+RPVKDDhDFkVqTkSXmX/SYEWWj+23ao5MqYxABsVE EAELhAlQfZEMl/7YV9N/BwpLYqpsVeCPSm2Y+J8Jq9qSFt/nXvVfspQs1d0RKJBs/cGH dKB3db3A6STZDcmJqLxfHISVlpiirJkS9NF+Wo1uQrCEHgMfpiF1gSb3tCOG1KAsdKqC 8a+Q== X-Forwarded-Encrypted: i=1; AL+hErGafRYvIoXWU8YFDx0VsgJNtsUeKLAJZg6/TAbsULTroDTo7FPc6IsXSWjtDwKUkkY0Tidqic1ldQsWfw==@vger.kernel.org X-Gm-Message-State: APuU4Z+G5I3LbgySiHQoY2EYaKkPa9p/jNqTCgCpeTlkrM9ugFgWhyz1 M/3WZMhTGbFTUIyoX5/UDmRGZ1c6KDr7f3zfBBawluu7Y/OjIJEkrYz3 X-Gm-Gg: AYBFou1a7L/EExPOQcDiQaSm3wTzU6vb9gT038ubNE07ztFR0QJLkWMe5QLXYRCzc+W 1J6onXz6mQC/p3v7MrwIHL3H1J4eL7ILXjpIRkHksqfYpLQNJ3SbjsSYCHNOD/Z8UnyEbDrw7kP e4xaDeaShIGc/Xe1WVlbP5+FySBzD+cMfRNzbtDZ30hBIvN5rgPJvwaAEas4UK7Jk5go8IvIK/4 RJjJqeLZJrwlF9NsFGz2pXMgn8OrzZbRb6tbBU80olvsHsAvBHtD1qEDQFKPcchlQPh2FkhHzS/ rrdU/kY6Z9lOiid0l+LE269gIpgZTbukIUepR8gszVs648F2eYCZLjeWc9dvG2b97KswqkqelmT NbomKbuXvJJCV7u5eYpeRVQkN64RpXYZKNaDXskMz5NJJnwiHecg/wMN862V4jm5FepQUxjDZRx 6hLS6PilwmUzAPsj8p3l24js0ruNqPIwKRJXUX7yIVS4v6VRMUWcge9og8CMskmWAMBvcL9m5gE VYnDt3L57om3EIzeOcGgN7BDDg0XBwmz1X3+glT2Lw8zsXGsHojwP2MtWMGfcVtcYcsLtJGzQn1 VHpLerT7ZAZxbAQ0FA9vyz+Z2pFK54P4/JNP0jQg+S95E7/dKjH+n2/+Noq+Tz3pJJEL5IfgvrB nkAWNzuPZ91To8VFsqTi45GLpBkQm/e+YzWreGiU6a3o+4oOX X-Received: by 2002:a05:6000:25c8:b0:48c:69b3:610f with SMTP id ffacd0b85a97d-4927678e034mr7928408f8f.26.1794001424398; Fri, 06 Nov 2026 13:43:44 -0800 (PST) Received: from DESKTOP-KHFMJSR ([194.9.62.193]) by smtp.gmail.com with ESMTPSA id ffacd0b85a97d-492d7cc6187sm5799505f8f.46.2026.11.06.13.43.42 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 06 Nov 2026 13:43:44 -0800 (PST) From: clicedvly768 To: ojeda@kernel.org, dmitry.torokhov@gmail.com Cc: rust-for-linux@vger.kernel.org, linux-input@vger.kernel.org, clicedvly768 Subject: [PATCH v4 2/2] rust: serio: add serio bus abstractions and port Gravis Stinger driver Date: Sat, 7 Nov 2026 02:43:22 +0500 Message-ID: <20261106214322.421869-3-harepro29@gmail.com> X-Mailer: git-send-email 2.56.0 In-Reply-To: <20261106214322.421869-1-harepro29@gmail.com> References: <20261106214322.421869-1-harepro29@gmail.com> X-Mailing-List: linux-input@vger.kernel.org List-Id: List-Post: List-Help: List-Subscribe: List-Unsubscribe: List-Owner: Precedence: list MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Add safe Rust abstractions for the serio (Serial I/O) bus subsystem and port the legacy Gravis Stinger serial gamepad driver to safe Rust. This introduces: - `DeviceId`: a transparent wrapper around `struct serio_device_id` implementing `RawDeviceId` for type-safe matching tables. - `IdTable` and `serio_device_table!` macro: guarantees a zero sentinel termination entry at compile time and creates modpost device aliases. - `Device`: a serio port device instance implementing `AsBusDevice`, `impl_device_context_deref!`, and `as_device()` for integration with kernel device abstractions. - Port lifecycle & interrupt race protection: `T::init` initializes driver state and registers driver data BEFORE `serio_open()` opens the hardware port, guaranteeing that incoming interrupts never encounter uninitialized state or NULL drvdata. Devices are published in `T::start`. - `IrqReturn` mapping: properly maps `kernel::irq::IrqReturn` variants to C `irqreturn_t` enum values. - `Driver` trait: safe interface for serio drivers (`init`, `start`, `interrupt`, `disconnect`). - `Registration`: safe RAII registration adapter that stores `Opaque` inside `Pin>` and calls `__serio_register_driver` with the caller's `&'static ThisModule` to correctly track module ownership. - `stinger_rust`: port of the Gravis Stinger serial gamepad driver in safe Rust (`drivers/input/joystick/stinger_rust.rs`), containing zero unsafe blocks, preserving the userspace device name ("Gravis Stinger") for udev/EVIOCGNAME, dynamically formatting phys paths ("%s/input0"), and compiling as the standard `stinger.ko` module name. - Non-regression Kconfig: adds `CONFIG_JOYSTICK_STINGER_RUST` guarded on `RUST && SERIO=y && INPUT=y` while retaining the original C driver (`stinger.c`) to maintain hardware support on non-Rust configurations and architectures without HAVE_RUST. - Gated module entry `#[cfg(CONFIG_SERIO = "y")]` and helper guards `#if IS_REACHABLE(CONFIG_SERIO)` to avoid undefined symbols when serio is disabled or modular. Signed-off-by: clicedvly768 --- drivers/input/joystick/Kconfig | 14 ++ drivers/input/joystick/Makefile | 3 + drivers/input/joystick/stinger_rust.rs | 187 ++++++++++++++++ rust/bindings/bindings_helper.h | 1 + rust/helpers/helpers.c | 1 + rust/helpers/serio.c | 17 ++ rust/kernel/lib.rs | 2 + rust/kernel/serio.rs | 298 +++++++++++++++++++++++++ 8 files changed, 523 insertions(+) create mode 100644 drivers/input/joystick/stinger_rust.rs create mode 100644 rust/helpers/serio.c create mode 100644 rust/kernel/serio.rs diff --git a/drivers/input/joystick/Kconfig b/drivers/input/joystick/Kconfig index 7755e5b454d2..89cc1dd9d865 100644 --- a/drivers/input/joystick/Kconfig +++ b/drivers/input/joystick/Kconfig @@ -197,6 +197,20 @@ config JOYSTICK_STINGER To compile this driver as a module, choose M here: the module will be called stinger. +config JOYSTICK_STINGER_RUST + bool "Safe Rust implementation of Gravis Stinger gamepad driver" + depends on JOYSTICK_STINGER + depends on RUST && SERIO = y && INPUT = y + default y + help + Say Y here to use the safe Rust rewrite of the Gravis Stinger + gamepad driver instead of the legacy C implementation. + + The Rust driver provides memory safety guarantees while preserving + full hardware protocol compatibility. + + If unsure, say Y. + config JOYSTICK_TWIDJOY tristate "Twiddler as a joystick" select SERIO diff --git a/drivers/input/joystick/Makefile b/drivers/input/joystick/Makefile index 9976f596a920..2ba3391af7c9 100644 --- a/drivers/input/joystick/Makefile +++ b/drivers/input/joystick/Makefile @@ -33,6 +33,9 @@ obj-$(CONFIG_JOYSTICK_SENSEHAT) += sensehat-joystick.o obj-$(CONFIG_JOYSTICK_SIDEWINDER) += sidewinder.o obj-$(CONFIG_JOYSTICK_SPACEBALL) += spaceball.o obj-$(CONFIG_JOYSTICK_SPACEORB) += spaceorb.o +ifdef CONFIG_JOYSTICK_STINGER_RUST +stinger-objs := stinger_rust.o +endif obj-$(CONFIG_JOYSTICK_STINGER) += stinger.o obj-$(CONFIG_JOYSTICK_TMDC) += tmdc.o obj-$(CONFIG_JOYSTICK_TURBOGRAFX) += turbografx.o diff --git a/drivers/input/joystick/stinger_rust.rs b/drivers/input/joystick/stinger_rust.rs new file mode 100644 index 000000000000..ca8d677ddbdb --- /dev/null +++ b/drivers/input/joystick/stinger_rust.rs @@ -0,0 +1,187 @@ +// SPDX-License-Identifier: GPL-2.0-or-later + +//! Gravis Stinger gamepad driver written in safe Rust. +//! +//! Rust port of legacy C driver `drivers/input/joystick/stinger.c`. +//! +//! Authors: +//! - Original C driver: Vojtech Pavlik , Mark Fletcher +//! - Rust port: Rust for Linux Contributors + +use kernel::{ + bindings, // + device, // + input::{ + bus, // + event_type, // + AllocatedDevice, // + RegisteredDevice, // + }, // + prelude::*, // + serio::{ + self, // + IrqReturn, // + }, // + types::ForeignOwnable, // +}; + +const DRIVER_NAME: &CStr = c"stinger"; +const DRIVER_DESC: &CStr = c"Gravis Stinger"; +const DRIVER_SERIO_DESC: &CStr = c"Gravis Stinger gamepad driver"; + +const STINGER_MAX_LENGTH: usize = 8; + +kernel::serio_device_table!( + STINGER_IDS, + [serio::DeviceId::new( + bindings::SERIO_RS232 as u8, + bindings::SERIO_ANY as u8, + bindings::SERIO_ANY as u8, + bindings::SERIO_STINGER as u8, + )] +); + +/// Per-device state for an attached Gravis Stinger gamepad. +struct Stinger { + input: RegisteredDevice, + idx: usize, + data: [u8; STINGER_MAX_LENGTH], +} + +impl Stinger { + /// Decodes incoming 4-byte packets from the Gravis Stinger and reports input events. + fn process_packet(&self) { + if self.idx == 0 { + return; + } + + let d0 = i32::from(self.data[0]); + let d1 = i32::from(self.data[1]); + let d2 = i32::from(self.data[2]); + let d3 = i32::from(self.data[3]); + + // Report button states (active high bits in packet) + self.input + .report_key(bindings::BTN_A, ((d0 & 0x20) >> 5) != 0); + self.input + .report_key(bindings::BTN_B, ((d0 & 0x10) >> 4) != 0); + self.input + .report_key(bindings::BTN_C, ((d0 & 0x08) >> 3) != 0); + self.input + .report_key(bindings::BTN_X, ((d0 & 0x04) >> 2) != 0); + self.input + .report_key(bindings::BTN_Y, ((d3 & 0x20) >> 5) != 0); + self.input + .report_key(bindings::BTN_Z, ((d3 & 0x10) >> 4) != 0); + self.input + .report_key(bindings::BTN_TL, ((d3 & 0x08) >> 3) != 0); + self.input + .report_key(bindings::BTN_TR, ((d3 & 0x04) >> 2) != 0); + self.input + .report_key(bindings::BTN_SELECT, ((d3 & 0x02) >> 1) != 0); + self.input.report_key(bindings::BTN_START, (d3 & 0x01) != 0); + + // Report 2-axis position: coordinates in range -64..64 + self.input + .report_abs(bindings::ABS_X, (d1 & 0x3f) - ((d0 & 0x01) << 6)); + self.input + .report_abs(bindings::ABS_Y, ((d0 & 0x02) << 5) - (d2 & 0x3f)); + + self.input.sync(); + } +} + +/// Serio driver implementation for Gravis Stinger gamepad. +struct StingerDriver; + +impl serio::Driver for StingerDriver { + type Data = KBox; + + const ID_TABLE: serio::IdTable = &STINGER_IDS; + + fn connect(dev: &serio::Device) -> Result { + let mut input_alloc = AllocatedDevice::new()?; + + input_alloc.set_name(DRIVER_DESC); + input_alloc.set_id(bus::RS232, bindings::SERIO_STINGER as u16, 0x0001, 0x0100); + input_alloc.set_parent(dev.as_device()); + input_alloc.set_phys_from_parent(dev.phys())?; + + // Configure supported buttons + for btn in [ + bindings::BTN_A, + bindings::BTN_B, + bindings::BTN_C, + bindings::BTN_X, + bindings::BTN_Y, + bindings::BTN_Z, + bindings::BTN_TL, + bindings::BTN_TR, + bindings::BTN_START, + bindings::BTN_SELECT, + ] { + input_alloc.set_capability(event_type::KEY, btn); + } + + // Configure 2-axis analog input + input_alloc.set_abs_params(bindings::ABS_X, -64, 64, 0, 4)?; + input_alloc.set_abs_params(bindings::ABS_Y, -64, 64, 0, 4)?; + + let registered = input_alloc.register()?; + + let stinger = KBox::new( + Stinger { + input: registered, + idx: 0, + data: [0; STINGER_MAX_LENGTH], + }, + GFP_KERNEL, + )?; + + Ok(stinger) + } + + fn interrupt( + stinger: &mut ::BorrowedMut<'_>, + data: u8, + _flags: u32, + ) -> IrqReturn { + if stinger.idx < STINGER_MAX_LENGTH { + stinger.data[stinger.idx] = data; + stinger.idx += 1; + } + + if stinger.idx == 4 { + stinger.process_packet(); + stinger.idx = 0; + } + + IrqReturn::Handled + } + + #[inline] + fn disconnect(_data: Self::Data) { + // Automatically drops `stinger`, unregistering and freeing the input device. + } +} + +module! { + type: StingerModule, + name: "stinger", + authors: ["Rust for Linux Contributors"], + description: "Gravis Stinger gamepad driver in safe Rust", + license: "GPL", +} + +struct StingerModule { + _reg: serio::Registration, +} + +impl kernel::Module for StingerModule { + fn init(module: &'static ThisModule) -> Result { + let reg = + serio::Registration::::new(DRIVER_NAME, DRIVER_SERIO_DESC, module)?; + pr_info!("Gravis Stinger safe Rust driver initialized\n"); + Ok(Self { _reg: reg }) + } +} diff --git a/rust/bindings/bindings_helper.h b/rust/bindings/bindings_helper.h index 4b09d3980e10..0e44af5d770c 100644 --- a/rust/bindings/bindings_helper.h +++ b/rust/bindings/bindings_helper.h @@ -89,6 +89,7 @@ #include #include #include +#include #include #include #include diff --git a/rust/helpers/helpers.c b/rust/helpers/helpers.c index 77cec85ad153..61cf3f77e85a 100644 --- a/rust/helpers/helpers.c +++ b/rust/helpers/helpers.c @@ -96,6 +96,7 @@ #include "scatterlist.c" #include "security.c" #include "serdev.c" +#include "serio.c" #include "signal.c" #include "slab.c" #include "spinlock.c" diff --git a/rust/helpers/serio.c b/rust/helpers/serio.c new file mode 100644 index 000000000000..849d0d48ac62 --- /dev/null +++ b/rust/helpers/serio.c @@ -0,0 +1,17 @@ +// SPDX-License-Identifier: GPL-2.0 + +#include + +#if IS_REACHABLE(CONFIG_SERIO) + +__rust_helper void *rust_helper_serio_get_drvdata(struct serio *serio) +{ + return serio_get_drvdata(serio); +} + +__rust_helper void rust_helper_serio_set_drvdata(struct serio *serio, void *data) +{ + serio_set_drvdata(serio, data); +} + +#endif /* IS_REACHABLE(CONFIG_SERIO) */ diff --git a/rust/kernel/lib.rs b/rust/kernel/lib.rs index ff5c978758d0..711b7ef06b57 100644 --- a/rust/kernel/lib.rs +++ b/rust/kernel/lib.rs @@ -134,6 +134,8 @@ pub mod seq_file; #[cfg(CONFIG_RUST_SERIAL_DEV_BUS_ABSTRACTIONS)] pub mod serdev; +#[cfg(CONFIG_SERIO = "y")] +pub mod serio; pub mod sizes; #[cfg(CONFIG_SOC_BUS)] pub mod soc; diff --git a/rust/kernel/serio.rs b/rust/kernel/serio.rs new file mode 100644 index 000000000000..1878055fb644 --- /dev/null +++ b/rust/kernel/serio.rs @@ -0,0 +1,298 @@ +// SPDX-License-Identifier: GPL-2.0 + +//! Serio (Serial I/O) bus abstractions for safe Rust drivers. +//! +//! Provides a safe Rust interface for serio devices and drivers in the Linux kernel, +//! supporting input devices such as serial gamepads (e.g. Gravis Stinger), mice, and keyboards. + +use crate::{ + bindings, // + device, // + device_id::{ + IdTable as GenericIdTable, // + RawDeviceId, // + }, // + error::{ + to_result, // + Result, // + }, // + ffi::{ + c_int, // + c_uchar, // + c_uint, // + }, // + prelude::*, // + types::{ + ForeignOwnable, // + Opaque, // + }, // + ThisModule, // +}; +use core::{ + marker::PhantomData, // + pin::Pin, // +}; + +pub use crate::irq::IrqReturn; + +/// Identifies supported serio hardware devices for auto-probing and matching. +#[repr(transparent)] +#[derive(Copy, Clone)] +pub struct DeviceId(bindings::serio_device_id); + +impl DeviceId { + /// Creates a new serio device identifier. + #[inline] + pub const fn new(type_: u8, extra: u8, id: u8, proto: u8) -> Self { + Self(bindings::serio_device_id { + type_, + extra, + id, + proto, + }) + } +} + +// SAFETY: `DeviceId` is a `#[repr(transparent)]` wrapper around `bindings::serio_device_id`. +unsafe impl RawDeviceId for DeviceId { + type RawType = bindings::serio_device_id; +} + +/// Type alias for serio device ID tables. +pub type IdTable = &'static dyn GenericIdTable; + +/// Creates a serio device table with a zero sentinel for module autoloading and matching. +#[macro_export] +macro_rules! serio_device_table { + ($table_name:ident, [$($id:expr),* $(,)?]) => { + $crate::module_device_table!( + "serio", + $crate::serio::DeviceId, + $table_name, + @none, + [$($id),*] + ); + }; +} + +/// A serio port device instance passed to driver callbacks. +#[repr(transparent)] +pub struct Device( + Opaque, + PhantomData, +); + +impl Device { + /// Returns the raw pointer to the underlying `struct serio`. + #[inline] + pub fn as_raw(&self) -> *mut bindings::serio { + self.0.get() + } + + /// Reads the physical device path into a buffer. + #[inline] + pub fn phys(&self) -> &[u8; 32] { + // SAFETY: `self.as_raw()` points to a valid `struct serio`. + unsafe { &(*self.as_raw()).phys } + } + + /// Returns a reference to the base [`device::Device`]. + #[inline] + pub fn as_device(&self) -> &device::Device { + // SAFETY: `self.as_raw()` points to a valid `struct serio`. + unsafe { + let dev = core::ptr::addr_of_mut!((*self.as_raw()).dev); + device::Device::from_raw(dev) + } + } +} + +// SAFETY: `serio::Device` is a transparent wrapper of `struct serio`. +// The offset is guaranteed to point to a valid device field inside `serio::Device`. +unsafe impl device::AsBusDevice for Device { + const OFFSET: usize = core::mem::offset_of!(bindings::serio, dev); +} + +kernel::impl_device_context_deref!(unsafe { Device }); + +impl AsRef> for Device { + #[inline] + fn as_ref(&self) -> &device::Device { + // SAFETY: By the type invariant of `Self`, `self.as_raw()` is a pointer to a valid + // `struct serio`. + let dev = unsafe { core::ptr::addr_of_mut!((*self.as_raw()).dev) }; + + // SAFETY: `dev` points to a valid `struct device`. + unsafe { device::Device::from_raw(dev) } + } +} + +/// Trait implemented by serio device drivers. +pub trait Driver: Send + Sync + Sized { + /// Context data stored per connected device instance. + type Data: ForeignOwnable + Send + Sync; + + /// Device ID match table. + const ID_TABLE: IdTable; + + /// Initializes driver data and registers child devices when a matching port is detected. + fn connect(dev: &Device) -> Result; + + /// Called in interrupt context when a new byte arrives from the serio port. + fn interrupt( + data: &mut ::BorrowedMut<'_>, + byte: u8, + flags: u32, + ) -> IrqReturn; + + /// Called when the device is disconnected. + #[inline] + fn disconnect(_data: Self::Data) {} +} + +/// Driver adapter that bridges the safe Rust [`Driver`] trait to the C serio bus subsystem. +pub struct Registration { + drv: Pin>>, + _p: PhantomData, +} + +impl Registration { + /// Registers a serio driver with the kernel. + pub fn new( + name: &'static CStr, + description: &'static CStr, + module: &'static ThisModule, + ) -> Result { + let drv = bindings::serio_driver { + description: description.as_char_ptr(), + id_table: T::ID_TABLE.as_ptr(), + manual_bind: false, + write_wakeup: None, + interrupt: Some(Self::interrupt_callback), + connect: Some(Self::connect_callback), + reconnect: None, + fast_reconnect: None, + disconnect: Some(Self::disconnect_callback), + cleanup: None, + driver: bindings::device_driver { + name: name.as_char_ptr(), + ..Default::default() + }, + }; + + let drv_box = KBox::into_pin(KBox::new(Opaque::new(drv), GFP_KERNEL)?); + + // SAFETY: `drv_box` is pinned on the kernel heap at a permanent address. + // `module` and `name` are valid static references. + let ret = unsafe { + bindings::__serio_register_driver(drv_box.get(), module.as_ptr(), name.as_char_ptr()) + }; + to_result(ret)?; + + Ok(Self { + drv: drv_box, + _p: PhantomData, + }) + } + + /// # Safety + /// + /// Must only be invoked by the serio subsystem when a matching port is probed. + /// `serio` and `drv` must be valid non-null pointers provided by the kernel. + unsafe extern "C" fn connect_callback( + serio: *mut bindings::serio, + drv: *mut bindings::serio_driver, + ) -> c_int { + if serio.is_null() { + return crate::error::code::EINVAL.to_errno(); + } + + // SAFETY: `serio` is valid. `Device` is repr(transparent). + let dev = unsafe { &*(serio.cast::>()) }; + + // 1. Initialize driver data and register input devices before the port is opened. + let data = match T::connect(dev) { + Ok(d) => d, + Err(e) => return e.to_errno(), + }; + + let raw_data = data.into_foreign(); + + // 2. Set drvdata BEFORE opening port so interrupts never encounter NULL. + // SAFETY: `serio` is valid; store driver data pointer. + unsafe { + bindings::serio_set_drvdata(serio, raw_data.cast()); + } + + // 3. Open serio port. + // SAFETY: `serio` and `drv` are valid non-null pointers provided by the kernel. + let ret = unsafe { bindings::serio_open(serio, drv) }; + if ret != 0 { + // SAFETY: Clean up drvdata if open failed. + unsafe { + bindings::serio_set_drvdata(serio, core::ptr::null_mut()); + let data = ::from_foreign(raw_data); + T::disconnect(data); + } + return ret; + } + + 0 + } + + /// # Safety + /// + /// Must only be invoked by the serio subsystem during an interrupt on a connected port. + /// `serio` must be a valid pointer. + unsafe extern "C" fn interrupt_callback( + serio: *mut bindings::serio, + data: c_uchar, + flags: c_uint, + ) -> bindings::irqreturn_t { + // SAFETY: `serio` is valid. + let raw = unsafe { bindings::serio_get_drvdata(serio) }; + if raw.is_null() { + return bindings::irqreturn_t(IrqReturn::None as c_uint); + } + + // SAFETY: `raw` was created via `into_foreign()` in `connect_callback`. + let mut borrowed = unsafe { ::borrow_mut(raw) }; + let ret = T::interrupt(&mut borrowed, data, flags); + bindings::irqreturn_t(ret as c_uint) + } + + /// # Safety + /// + /// Must only be invoked by the serio subsystem when disconnecting a port. + /// `serio` must be a valid pointer. + unsafe extern "C" fn disconnect_callback(serio: *mut bindings::serio) { + // SAFETY: `serio` is valid. + let raw = unsafe { bindings::serio_get_drvdata(serio) }; + if raw.is_null() { + return; + } + + // SAFETY: Close port, clear drvdata, and pass owned data back to disconnect. + unsafe { + bindings::serio_close(serio); + bindings::serio_set_drvdata(serio, core::ptr::null_mut()); + let data = ::from_foreign(raw); + T::disconnect(data); + } + } +} + +impl Drop for Registration { + #[inline] + fn drop(&mut self) { + // SAFETY: Unregister driver with kernel. `self.drv` is valid and registered. + unsafe { + bindings::serio_unregister_driver(self.drv.get()); + } + } +} + +// SAFETY: `Registration` can be safely sent to another thread. +unsafe impl Send for Registration {} +// SAFETY: `Registration` can be safely shared across threads. +unsafe impl Sync for Registration {} -- 2.56.0