xref: /DragonOS/kernel/src/driver/base/subsys.rs (revision 4ad52e57e612a88ab09413c7ac0072db96a93632)
1 use core::{
2     fmt::Debug,
3     sync::atomic::{AtomicBool, Ordering},
4 };
5 
6 use crate::libs::{
7     notifier::AtomicNotifierChain,
8     rwlock::{RwLock, RwLockReadGuard},
9     spinlock::SpinLock,
10 };
11 use alloc::{
12     string::String,
13     sync::{Arc, Weak},
14     vec::Vec,
15 };
16 use system_error::SystemError;
17 
18 use super::{
19     class::Class,
20     device::{
21         bus::{Bus, BusNotifyEvent},
22         driver::Driver,
23         Device,
24     },
25     kset::KSet,
26 };
27 
28 /// 一个用于存储bus/class的驱动核心部分的信息的结构体
29 #[derive(Debug)]
30 pub struct SubSysPrivate {
31     /// 用于定义这个子系统的kset
32     subsys: Arc<KSet>,
33     ksets: RwLock<SubSysKSets>,
34     /// 指向拥有当前结构体的`dyn bus`对象的弱引用
35     bus: SpinLock<Option<Weak<dyn Bus>>>,
36     /// 指向拥有当前结构体的`dyn class`对象的弱引用
37     class: SpinLock<Option<Weak<dyn Class>>>,
38     drivers_autoprobe: AtomicBool,
39     /// 当前总线上的所有设备
40     devices: RwLock<Vec<Arc<dyn Device>>>,
41     /// 当前总线上的所有驱动
42     drivers: RwLock<Vec<Arc<dyn Driver>>>,
43     interfaces: &'static [&'static dyn SubSysInterface],
44     bus_notifier: AtomicNotifierChain<BusNotifyEvent, Arc<dyn Device>>,
45 }
46 
47 #[derive(Debug)]
48 struct SubSysKSets {
49     /// 子系统的`devices`目录
50     devices_kset: Option<Arc<KSet>>,
51     /// 子系统的`drivers`目录
52     drivers_kset: Option<Arc<KSet>>,
53 }
54 
55 impl SubSysKSets {
56     pub fn new() -> Self {
57         return Self {
58             devices_kset: None,
59             drivers_kset: None,
60         };
61     }
62 }
63 
64 impl SubSysPrivate {
65     pub fn new(
66         name: String,
67         bus: Option<Weak<dyn Bus>>,
68         class: Option<Weak<dyn Class>>,
69         interfaces: &'static [&'static dyn SubSysInterface],
70     ) -> Self {
71         let subsys = KSet::new(name);
72         return Self {
73             subsys,
74             ksets: RwLock::new(SubSysKSets::new()),
75             drivers_autoprobe: AtomicBool::new(false),
76             bus: SpinLock::new(bus),
77             class: SpinLock::new(class),
78             devices: RwLock::new(Vec::new()),
79             drivers: RwLock::new(Vec::new()),
80             interfaces,
81             bus_notifier: AtomicNotifierChain::new(),
82         };
83     }
84 
85     pub fn subsys(&self) -> Arc<KSet> {
86         return self.subsys.clone();
87     }
88 
89     #[inline]
90     #[allow(dead_code)]
91     pub fn bus(&self) -> Option<Weak<dyn Bus>> {
92         return self.bus.lock().clone();
93     }
94 
95     pub fn set_bus(&self, bus: Option<Weak<dyn Bus>>) {
96         *self.bus.lock() = bus;
97     }
98 
99     #[allow(dead_code)]
100     #[inline]
101     pub fn class(&self) -> Option<Weak<dyn Class>> {
102         return self.class.lock().clone();
103     }
104 
105     pub fn set_class(&self, class: Option<Weak<dyn Class>>) {
106         *self.class.lock() = class;
107     }
108 
109     pub fn devices(&self) -> RwLockReadGuard<Vec<Arc<dyn Device>>> {
110         return self.devices.read();
111     }
112 
113     pub fn drivers(&self) -> RwLockReadGuard<Vec<Arc<dyn Driver>>> {
114         return self.drivers.read();
115     }
116 
117     pub fn drivers_autoprobe(&self) -> bool {
118         return self.drivers_autoprobe.load(Ordering::SeqCst);
119     }
120 
121     pub fn set_drivers_autoprobe(&self, drivers_autoprobe: bool) {
122         self.drivers_autoprobe
123             .store(drivers_autoprobe, Ordering::SeqCst);
124     }
125 
126     #[allow(dead_code)]
127     #[inline]
128     pub fn devices_kset(&self) -> Option<Arc<KSet>> {
129         return self.ksets.read().devices_kset.clone();
130     }
131 
132     #[allow(dead_code)]
133     #[inline]
134     pub fn set_devices_kset(&self, devices_kset: Arc<KSet>) {
135         self.ksets.write().devices_kset = Some(devices_kset);
136     }
137 
138     #[allow(dead_code)]
139     #[inline]
140     pub fn drivers_kset(&self) -> Option<Arc<KSet>> {
141         return self.ksets.read().drivers_kset.clone();
142     }
143 
144     pub fn set_drivers_kset(&self, drivers_kset: Arc<KSet>) {
145         self.ksets.write().drivers_kset = Some(drivers_kset);
146     }
147 
148     pub fn bus_notifier(&self) -> &AtomicNotifierChain<BusNotifyEvent, Arc<dyn Device>> {
149         return &self.bus_notifier;
150     }
151 
152     pub fn interfaces(&self) -> &'static [&'static dyn SubSysInterface] {
153         return self.interfaces;
154     }
155 
156     pub fn add_driver_to_vec(&self, driver: &Arc<dyn Driver>) -> Result<(), SystemError> {
157         let mut drivers = self.drivers.write();
158         if drivers.iter().any(|d| Arc::ptr_eq(d, driver)) {
159             return Err(SystemError::EEXIST);
160         }
161         drivers.push(driver.clone());
162         return Ok(());
163     }
164 
165     pub fn remove_driver_from_vec(&self, driver: &Arc<dyn Driver>) {
166         let mut drivers = self.drivers.write();
167         let index = drivers.iter().position(|d| Arc::ptr_eq(d, driver));
168         if let Some(index) = index {
169             drivers.remove(index);
170         }
171     }
172 
173     pub fn add_device_to_vec(&self, device: &Arc<dyn Device>) -> Result<(), SystemError> {
174         let mut devices = self.devices.write();
175         if devices.iter().any(|d| Arc::ptr_eq(d, device)) {
176             return Err(SystemError::EEXIST);
177         }
178         devices.push(device.clone());
179         return Ok(());
180     }
181 
182     #[allow(dead_code)]
183     pub fn remove_device_from_vec(&self, device: &Arc<dyn Device>) {
184         let mut devices = self.devices.write();
185         let index = devices.iter().position(|d| Arc::ptr_eq(d, device));
186         if let Some(index) = index {
187             devices.remove(index);
188         }
189     }
190 }
191 
192 /// 参考: https://code.dragonos.org.cn/xref/linux-6.1.9/include/linux/device.h#63
193 pub trait SubSysInterface: Debug + Send + Sync {
194     fn name(&self) -> &str;
195     fn bus(&self) -> Option<Weak<dyn Bus>>;
196     fn set_bus(&self, bus: Option<Weak<dyn Bus>>);
197     fn add_device(&self, _device: &Arc<dyn Device>) -> Result<(), SystemError> {
198         return Err(SystemError::EOPNOTSUPP_OR_ENOTSUP);
199     }
200     fn remove_device(&self, device: &Arc<dyn Device>);
201 }
202