virtio_net.rs 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946
  1. use core::{
  2. any::Any,
  3. cell::UnsafeCell,
  4. fmt::{Debug, Formatter},
  5. ops::{Deref, DerefMut},
  6. };
  7. use alloc::{
  8. string::{String, ToString},
  9. sync::{Arc, Weak},
  10. vec::Vec,
  11. };
  12. use log::{debug, error};
  13. use smoltcp::{iface, phy, wire};
  14. use unified_init::macros::unified_init;
  15. use virtio_drivers::device::net::VirtIONet;
  16. use super::{Iface, NetDeivceState, NetDeviceCommonData, Operstate};
  17. use crate::{
  18. arch::rand::rand,
  19. driver::{
  20. base::{
  21. class::Class,
  22. device::{
  23. bus::Bus,
  24. driver::{Driver, DriverCommonData},
  25. Device, DeviceCommonData, DeviceId, DeviceType, IdTable,
  26. },
  27. kobject::{KObjType, KObject, KObjectCommonData, KObjectState, LockedKObjectState},
  28. kset::KSet,
  29. },
  30. net::register_netdevice,
  31. virtio::{
  32. irq::virtio_irq_manager,
  33. sysfs::{virtio_bus, virtio_device_manager, virtio_driver_manager},
  34. transport::VirtIOTransport,
  35. virtio_impl::HalImpl,
  36. VirtIODevice, VirtIODeviceIndex, VirtIODriver, VirtIODriverCommonData, VirtioDeviceId,
  37. VIRTIO_VENDOR_ID,
  38. },
  39. },
  40. exception::{irqdesc::IrqReturn, IrqNumber},
  41. filesystem::{kernfs::KernFSInode, sysfs::AttributeGroup},
  42. init::initcall::INITCALL_POSTCORE,
  43. libs::{
  44. rwlock::{RwLockReadGuard, RwLockWriteGuard},
  45. spinlock::{SpinLock, SpinLockGuard},
  46. },
  47. net::{generate_iface_id, NET_DEVICES},
  48. time::Instant,
  49. };
  50. use system_error::SystemError;
  51. static mut VIRTIO_NET_DRIVER: Option<Arc<VirtIONetDriver>> = None;
  52. const VIRTIO_NET_BASENAME: &str = "virtio_net";
  53. #[inline(always)]
  54. #[allow(dead_code)]
  55. fn virtio_net_driver() -> Arc<VirtIONetDriver> {
  56. unsafe { VIRTIO_NET_DRIVER.as_ref().unwrap().clone() }
  57. }
  58. /// virtio net device
  59. #[cast_to([sync] VirtIODevice)]
  60. #[cast_to([sync] Device)]
  61. pub struct VirtIONetDevice {
  62. dev_id: Arc<DeviceId>,
  63. inner: SpinLock<InnerVirtIONetDevice>,
  64. locked_kobj_state: LockedKObjectState,
  65. }
  66. impl Debug for VirtIONetDevice {
  67. fn fmt(&self, f: &mut Formatter<'_>) -> core::fmt::Result {
  68. f.debug_struct("VirtIONetDevice")
  69. .field("dev_id", &self.dev_id.id())
  70. .finish()
  71. }
  72. }
  73. unsafe impl Send for VirtIONetDevice {}
  74. unsafe impl Sync for VirtIONetDevice {}
  75. struct InnerVirtIONetDevice {
  76. device_inner: VirtIONicDeviceInner,
  77. name: Option<String>,
  78. virtio_index: Option<VirtIODeviceIndex>,
  79. kobj_common: KObjectCommonData,
  80. device_common: DeviceCommonData,
  81. }
  82. impl Debug for InnerVirtIONetDevice {
  83. fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
  84. f.debug_struct("InnerVirtIONetDevice").finish()
  85. }
  86. }
  87. impl VirtIONetDevice {
  88. pub fn new(transport: VirtIOTransport, dev_id: Arc<DeviceId>) -> Option<Arc<Self>> {
  89. // 设置中断
  90. if let Err(err) = transport.setup_irq(dev_id.clone()) {
  91. error!("VirtIONetDevice '{dev_id:?}' setup_irq failed: {:?}", err);
  92. return None;
  93. }
  94. let driver_net: VirtIONet<HalImpl, VirtIOTransport, 2> =
  95. match VirtIONet::<HalImpl, VirtIOTransport, 2>::new(transport, 4096) {
  96. Ok(net) => net,
  97. Err(_) => {
  98. error!("VirtIONet init failed");
  99. return None;
  100. }
  101. };
  102. let mac = wire::EthernetAddress::from_bytes(&driver_net.mac_address());
  103. debug!("VirtIONetDevice mac: {:?}", mac);
  104. let device_inner = VirtIONicDeviceInner::new(driver_net);
  105. device_inner.inner.lock_irqsave().enable_interrupts();
  106. let dev = Arc::new(Self {
  107. dev_id,
  108. inner: SpinLock::new(InnerVirtIONetDevice {
  109. device_inner,
  110. name: None,
  111. virtio_index: None,
  112. kobj_common: KObjectCommonData::default(),
  113. device_common: DeviceCommonData::default(),
  114. }),
  115. locked_kobj_state: LockedKObjectState::default(),
  116. });
  117. // dev.set_driver(Some(Arc::downgrade(&virtio_net_driver()) as Weak<dyn Driver>));
  118. return Some(dev);
  119. }
  120. fn inner(&self) -> SpinLockGuard<'_, InnerVirtIONetDevice> {
  121. return self.inner.lock();
  122. }
  123. }
  124. impl KObject for VirtIONetDevice {
  125. fn as_any_ref(&self) -> &dyn Any {
  126. self
  127. }
  128. fn set_inode(&self, inode: Option<Arc<KernFSInode>>) {
  129. self.inner().kobj_common.kern_inode = inode;
  130. }
  131. fn inode(&self) -> Option<Arc<KernFSInode>> {
  132. self.inner().kobj_common.kern_inode.clone()
  133. }
  134. fn parent(&self) -> Option<Weak<dyn KObject>> {
  135. self.inner().kobj_common.parent.clone()
  136. }
  137. fn set_parent(&self, parent: Option<Weak<dyn KObject>>) {
  138. self.inner().kobj_common.parent = parent;
  139. }
  140. fn kset(&self) -> Option<Arc<KSet>> {
  141. self.inner().kobj_common.kset.clone()
  142. }
  143. fn set_kset(&self, kset: Option<Arc<KSet>>) {
  144. self.inner().kobj_common.kset = kset;
  145. }
  146. fn kobj_type(&self) -> Option<&'static dyn KObjType> {
  147. self.inner().kobj_common.kobj_type
  148. }
  149. fn set_kobj_type(&self, ktype: Option<&'static dyn KObjType>) {
  150. self.inner().kobj_common.kobj_type = ktype;
  151. }
  152. fn name(&self) -> String {
  153. self.device_name()
  154. }
  155. fn set_name(&self, _name: String) {
  156. // do nothing
  157. }
  158. fn kobj_state(&self) -> RwLockReadGuard<'_, KObjectState> {
  159. self.locked_kobj_state.read()
  160. }
  161. fn kobj_state_mut(&self) -> RwLockWriteGuard<'_, KObjectState> {
  162. self.locked_kobj_state.write()
  163. }
  164. fn set_kobj_state(&self, state: KObjectState) {
  165. *self.locked_kobj_state.write() = state;
  166. }
  167. }
  168. impl Device for VirtIONetDevice {
  169. fn dev_type(&self) -> DeviceType {
  170. DeviceType::Net
  171. }
  172. fn id_table(&self) -> IdTable {
  173. IdTable::new(VIRTIO_NET_BASENAME.to_string(), None)
  174. }
  175. fn bus(&self) -> Option<Weak<dyn Bus>> {
  176. self.inner().device_common.bus.clone()
  177. }
  178. fn set_bus(&self, bus: Option<Weak<dyn Bus>>) {
  179. self.inner().device_common.bus = bus;
  180. }
  181. fn class(&self) -> Option<Arc<dyn Class>> {
  182. let mut guard = self.inner();
  183. let r = guard.device_common.class.clone()?.upgrade();
  184. if r.is_none() {
  185. guard.device_common.class = None;
  186. }
  187. return r;
  188. }
  189. fn set_class(&self, class: Option<Weak<dyn Class>>) {
  190. self.inner().device_common.class = class;
  191. }
  192. fn driver(&self) -> Option<Arc<dyn Driver>> {
  193. let r = self.inner().device_common.driver.clone()?.upgrade();
  194. if r.is_none() {
  195. self.inner().device_common.driver = None;
  196. }
  197. return r;
  198. }
  199. fn set_driver(&self, driver: Option<Weak<dyn Driver>>) {
  200. self.inner().device_common.driver = driver;
  201. }
  202. fn is_dead(&self) -> bool {
  203. false
  204. }
  205. fn can_match(&self) -> bool {
  206. self.inner().device_common.can_match
  207. }
  208. fn set_can_match(&self, can_match: bool) {
  209. self.inner().device_common.can_match = can_match;
  210. }
  211. fn state_synced(&self) -> bool {
  212. true
  213. }
  214. fn dev_parent(&self) -> Option<Weak<dyn Device>> {
  215. self.inner().device_common.get_parent_weak_or_clear()
  216. }
  217. fn set_dev_parent(&self, parent: Option<Weak<dyn Device>>) {
  218. self.inner().device_common.parent = parent;
  219. }
  220. fn attribute_groups(&self) -> Option<&'static [&'static dyn AttributeGroup]> {
  221. None
  222. }
  223. }
  224. impl VirtIODevice for VirtIONetDevice {
  225. fn handle_irq(&self, _irq: IrqNumber) -> Result<IrqReturn, SystemError> {
  226. super::kthread::wakeup_poll_thread();
  227. return Ok(IrqReturn::Handled);
  228. }
  229. fn dev_id(&self) -> &Arc<DeviceId> {
  230. return &self.dev_id;
  231. }
  232. fn set_device_name(&self, name: String) {
  233. self.inner().name = Some(name);
  234. }
  235. fn device_name(&self) -> String {
  236. self.inner()
  237. .name
  238. .clone()
  239. .unwrap_or_else(|| "virtio_net".to_string())
  240. }
  241. fn set_virtio_device_index(&self, index: VirtIODeviceIndex) {
  242. self.inner().virtio_index = Some(index);
  243. }
  244. fn virtio_device_index(&self) -> Option<VirtIODeviceIndex> {
  245. return self.inner().virtio_index;
  246. }
  247. fn device_type_id(&self) -> u32 {
  248. virtio_drivers::transport::DeviceType::Network as u32
  249. }
  250. fn vendor(&self) -> u32 {
  251. VIRTIO_VENDOR_ID.into()
  252. }
  253. fn irq(&self) -> Option<IrqNumber> {
  254. None
  255. }
  256. }
  257. pub struct VirtIoNetImpl {
  258. inner: VirtIONet<HalImpl, VirtIOTransport, 2>,
  259. }
  260. impl VirtIoNetImpl {
  261. const fn new(inner: VirtIONet<HalImpl, VirtIOTransport, 2>) -> Self {
  262. Self { inner }
  263. }
  264. }
  265. impl Deref for VirtIoNetImpl {
  266. type Target = VirtIONet<HalImpl, VirtIOTransport, 2>;
  267. fn deref(&self) -> &Self::Target {
  268. &self.inner
  269. }
  270. }
  271. impl DerefMut for VirtIoNetImpl {
  272. fn deref_mut(&mut self) -> &mut Self::Target {
  273. &mut self.inner
  274. }
  275. }
  276. unsafe impl Send for VirtIoNetImpl {}
  277. unsafe impl Sync for VirtIoNetImpl {}
  278. #[derive(Debug)]
  279. struct VirtIONicDeviceInnerWrapper(UnsafeCell<VirtIONicDeviceInner>);
  280. unsafe impl Send for VirtIONicDeviceInnerWrapper {}
  281. unsafe impl Sync for VirtIONicDeviceInnerWrapper {}
  282. impl Deref for VirtIONicDeviceInnerWrapper {
  283. type Target = VirtIONicDeviceInner;
  284. fn deref(&self) -> &Self::Target {
  285. unsafe { &*self.0.get() }
  286. }
  287. }
  288. impl DerefMut for VirtIONicDeviceInnerWrapper {
  289. fn deref_mut(&mut self) -> &mut Self::Target {
  290. unsafe { &mut *self.0.get() }
  291. }
  292. }
  293. #[allow(clippy::mut_from_ref)]
  294. impl VirtIONicDeviceInnerWrapper {
  295. fn force_get_mut(&self) -> &mut <VirtIONicDeviceInnerWrapper as Deref>::Target {
  296. unsafe { &mut *self.0.get() }
  297. }
  298. }
  299. /// Virtio网络设备驱动(加锁)
  300. pub struct VirtIONicDeviceInner {
  301. pub inner: Arc<SpinLock<VirtIoNetImpl>>,
  302. }
  303. impl Clone for VirtIONicDeviceInner {
  304. fn clone(&self) -> Self {
  305. return VirtIONicDeviceInner {
  306. inner: self.inner.clone(),
  307. };
  308. }
  309. }
  310. impl Debug for VirtIONicDeviceInner {
  311. fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
  312. f.debug_struct("VirtIONicDriver").finish()
  313. }
  314. }
  315. #[cast_to([sync] Iface)]
  316. #[cast_to([sync] Device)]
  317. #[derive(Debug)]
  318. pub struct VirtioInterface {
  319. device_inner: VirtIONicDeviceInnerWrapper,
  320. iface_name: String,
  321. iface_common: super::IfaceCommon,
  322. inner: SpinLock<InnerVirtIOInterface>,
  323. locked_kobj_state: LockedKObjectState,
  324. }
  325. #[derive(Debug)]
  326. struct InnerVirtIOInterface {
  327. kobj_common: KObjectCommonData,
  328. device_common: DeviceCommonData,
  329. netdevice_common: NetDeviceCommonData,
  330. }
  331. impl VirtioInterface {
  332. pub fn new(mut device_inner: VirtIONicDeviceInner) -> Arc<Self> {
  333. let iface_id = generate_iface_id();
  334. let mut iface_config = iface::Config::new(wire::HardwareAddress::Ethernet(
  335. wire::EthernetAddress(device_inner.inner.lock().mac_address()),
  336. ));
  337. iface_config.random_seed = rand() as u64;
  338. let iface = iface::Interface::new(iface_config, &mut device_inner, Instant::now().into());
  339. let result = Arc::new(VirtioInterface {
  340. device_inner: VirtIONicDeviceInnerWrapper(UnsafeCell::new(device_inner)),
  341. locked_kobj_state: LockedKObjectState::default(),
  342. iface_name: format!("eth{}", iface_id),
  343. iface_common: super::IfaceCommon::new(iface_id, true, iface),
  344. inner: SpinLock::new(InnerVirtIOInterface {
  345. kobj_common: KObjectCommonData::default(),
  346. device_common: DeviceCommonData::default(),
  347. netdevice_common: NetDeviceCommonData::default(),
  348. }),
  349. });
  350. return result;
  351. }
  352. fn inner(&self) -> SpinLockGuard<'_, InnerVirtIOInterface> {
  353. return self.inner.lock();
  354. }
  355. /// 获取网卡接口的名称
  356. #[allow(dead_code)]
  357. pub fn iface_name(&self) -> String {
  358. self.iface_name.clone()
  359. }
  360. }
  361. impl Drop for VirtioInterface {
  362. fn drop(&mut self) {
  363. // 从全局的网卡接口信息表中删除这个网卡的接口信息
  364. NET_DEVICES.write_irqsave().remove(&self.nic_id());
  365. }
  366. }
  367. impl Device for VirtioInterface {
  368. fn dev_type(&self) -> DeviceType {
  369. DeviceType::Net
  370. }
  371. fn id_table(&self) -> IdTable {
  372. IdTable::new(VIRTIO_NET_BASENAME.to_string(), None)
  373. }
  374. fn bus(&self) -> Option<Weak<dyn Bus>> {
  375. self.inner().device_common.bus.clone()
  376. }
  377. fn set_bus(&self, bus: Option<Weak<dyn Bus>>) {
  378. self.inner().device_common.bus = bus;
  379. }
  380. fn class(&self) -> Option<Arc<dyn Class>> {
  381. let mut guard = self.inner();
  382. let r = guard.device_common.class.clone()?.upgrade();
  383. if r.is_none() {
  384. guard.device_common.class = None;
  385. }
  386. return r;
  387. }
  388. fn set_class(&self, class: Option<Weak<dyn Class>>) {
  389. self.inner().device_common.class = class;
  390. }
  391. fn driver(&self) -> Option<Arc<dyn Driver>> {
  392. let r = self.inner().device_common.driver.clone()?.upgrade();
  393. if r.is_none() {
  394. self.inner().device_common.driver = None;
  395. }
  396. return r;
  397. }
  398. fn set_driver(&self, driver: Option<Weak<dyn Driver>>) {
  399. self.inner().device_common.driver = driver;
  400. }
  401. fn is_dead(&self) -> bool {
  402. false
  403. }
  404. fn can_match(&self) -> bool {
  405. self.inner().device_common.can_match
  406. }
  407. fn set_can_match(&self, can_match: bool) {
  408. self.inner().device_common.can_match = can_match;
  409. }
  410. fn state_synced(&self) -> bool {
  411. true
  412. }
  413. fn dev_parent(&self) -> Option<Weak<dyn Device>> {
  414. self.inner().device_common.get_parent_weak_or_clear()
  415. }
  416. fn set_dev_parent(&self, parent: Option<Weak<dyn Device>>) {
  417. self.inner().device_common.parent = parent;
  418. }
  419. }
  420. impl VirtIONicDeviceInner {
  421. pub fn new(driver_net: VirtIONet<HalImpl, VirtIOTransport, 2>) -> Self {
  422. let mut iface_config = iface::Config::new(wire::HardwareAddress::Ethernet(
  423. wire::EthernetAddress(driver_net.mac_address()),
  424. ));
  425. iface_config.random_seed = rand() as u64;
  426. let inner = Arc::new(SpinLock::new(VirtIoNetImpl::new(driver_net)));
  427. let result = VirtIONicDeviceInner { inner };
  428. return result;
  429. }
  430. }
  431. pub struct VirtioNetToken {
  432. driver: VirtIONicDeviceInner,
  433. rx_buffer: Option<virtio_drivers::device::net::RxBuffer>,
  434. }
  435. impl VirtioNetToken {
  436. pub fn new(
  437. driver: VirtIONicDeviceInner,
  438. rx_buffer: Option<virtio_drivers::device::net::RxBuffer>,
  439. ) -> Self {
  440. return Self { driver, rx_buffer };
  441. }
  442. }
  443. impl phy::Device for VirtIONicDeviceInner {
  444. type RxToken<'a>
  445. = VirtioNetToken
  446. where
  447. Self: 'a;
  448. type TxToken<'a>
  449. = VirtioNetToken
  450. where
  451. Self: 'a;
  452. fn receive(
  453. &mut self,
  454. _timestamp: smoltcp::time::Instant,
  455. ) -> Option<(Self::RxToken<'_>, Self::TxToken<'_>)> {
  456. match self.inner.lock().receive() {
  457. Ok(buf) => Some((
  458. VirtioNetToken::new(self.clone(), Some(buf)),
  459. VirtioNetToken::new(self.clone(), None),
  460. )),
  461. Err(virtio_drivers::Error::NotReady) => None,
  462. Err(err) => panic!("VirtIO receive failed: {}", err),
  463. }
  464. }
  465. fn transmit(&mut self, _timestamp: smoltcp::time::Instant) -> Option<Self::TxToken<'_>> {
  466. // debug!("VirtioNet: transmit");
  467. if self.inner.lock_irqsave().can_send() {
  468. // debug!("VirtioNet: can send");
  469. return Some(VirtioNetToken::new(self.clone(), None));
  470. } else {
  471. // debug!("VirtioNet: can not send");
  472. return None;
  473. }
  474. }
  475. fn capabilities(&self) -> phy::DeviceCapabilities {
  476. let mut caps = phy::DeviceCapabilities::default();
  477. // 网卡的最大传输单元. 请与IP层的MTU进行区分。这个值应当是网卡的最大传输单元,而不是IP层的MTU。
  478. caps.max_transmission_unit = 2000;
  479. /*
  480. Maximum burst size, in terms of MTU.
  481. The network device is unable to send or receive bursts large than the value returned by this function.
  482. If None, there is no fixed limit on burst size, e.g. if network buffers are dynamically allocated.
  483. */
  484. caps.max_burst_size = Some(1);
  485. return caps;
  486. }
  487. }
  488. impl phy::TxToken for VirtioNetToken {
  489. fn consume<R, F>(self, len: usize, f: F) -> R
  490. where
  491. F: FnOnce(&mut [u8]) -> R,
  492. {
  493. // // 为了线程安全,这里需要对VirtioNet进行加【写锁】,以保证对设备的互斥访问。
  494. let mut driver_net = self.driver.inner.lock();
  495. let mut tx_buf = driver_net.new_tx_buffer(len);
  496. let result = f(tx_buf.packet_mut());
  497. driver_net.send(tx_buf).expect("virtio_net send failed");
  498. return result;
  499. }
  500. }
  501. impl phy::RxToken for VirtioNetToken {
  502. fn consume<R, F>(self, f: F) -> R
  503. where
  504. F: FnOnce(&[u8]) -> R,
  505. {
  506. // 为了线程安全,这里需要对VirtioNet进行加【写锁】,以保证对设备的互斥访问。
  507. let rx_buf = self.rx_buffer.unwrap();
  508. let result = f(rx_buf.packet());
  509. self.driver
  510. .inner
  511. .lock()
  512. .recycle_rx_buffer(rx_buf)
  513. .expect("virtio_net recv failed");
  514. result
  515. }
  516. }
  517. /// @brief virtio-net 驱动的初始化与测试
  518. pub fn virtio_net(
  519. transport: VirtIOTransport,
  520. dev_id: Arc<DeviceId>,
  521. dev_parent: Option<Arc<dyn Device>>,
  522. ) {
  523. let virtio_net_deivce = VirtIONetDevice::new(transport, dev_id);
  524. if let Some(virtio_net_deivce) = virtio_net_deivce {
  525. debug!("VirtIONetDevice '{:?}' created", virtio_net_deivce.dev_id);
  526. if let Some(dev_parent) = dev_parent {
  527. virtio_net_deivce.set_dev_parent(Some(Arc::downgrade(&dev_parent)));
  528. }
  529. virtio_device_manager()
  530. .device_add(virtio_net_deivce.clone() as Arc<dyn VirtIODevice>)
  531. .expect("Add virtio net failed");
  532. }
  533. }
  534. impl Iface for VirtioInterface {
  535. fn common(&self) -> &super::IfaceCommon {
  536. &self.iface_common
  537. }
  538. fn mac(&self) -> wire::EthernetAddress {
  539. let mac: [u8; 6] = self.device_inner.inner.lock().mac_address();
  540. return wire::EthernetAddress::from_bytes(&mac);
  541. }
  542. #[inline]
  543. fn iface_name(&self) -> String {
  544. return self.iface_name.clone();
  545. }
  546. fn poll(&self) {
  547. // log::debug!("VirtioInterface: poll");
  548. self.iface_common.poll(self.device_inner.force_get_mut())
  549. }
  550. // fn as_any_ref(&'static self) -> &'static dyn core::any::Any {
  551. // return self;
  552. // }
  553. fn addr_assign_type(&self) -> u8 {
  554. return self.inner().netdevice_common.addr_assign_type;
  555. }
  556. fn net_device_type(&self) -> u16 {
  557. self.inner().netdevice_common.net_device_type = 1; // 以太网设备
  558. return self.inner().netdevice_common.net_device_type;
  559. }
  560. fn net_state(&self) -> NetDeivceState {
  561. return self.inner().netdevice_common.state;
  562. }
  563. fn set_net_state(&self, state: NetDeivceState) {
  564. self.inner().netdevice_common.state |= state;
  565. }
  566. fn operstate(&self) -> Operstate {
  567. return self.inner().netdevice_common.operstate;
  568. }
  569. fn set_operstate(&self, state: Operstate) {
  570. self.inner().netdevice_common.operstate = state;
  571. }
  572. }
  573. impl KObject for VirtioInterface {
  574. fn as_any_ref(&self) -> &dyn core::any::Any {
  575. self
  576. }
  577. fn set_inode(&self, inode: Option<Arc<KernFSInode>>) {
  578. self.inner().kobj_common.kern_inode = inode;
  579. }
  580. fn inode(&self) -> Option<Arc<KernFSInode>> {
  581. self.inner().kobj_common.kern_inode.clone()
  582. }
  583. fn parent(&self) -> Option<Weak<dyn KObject>> {
  584. self.inner().kobj_common.parent.clone()
  585. }
  586. fn set_parent(&self, parent: Option<Weak<dyn KObject>>) {
  587. self.inner().kobj_common.parent = parent;
  588. }
  589. fn kset(&self) -> Option<Arc<KSet>> {
  590. self.inner().kobj_common.kset.clone()
  591. }
  592. fn set_kset(&self, kset: Option<Arc<KSet>>) {
  593. self.inner().kobj_common.kset = kset;
  594. }
  595. fn kobj_type(&self) -> Option<&'static dyn KObjType> {
  596. self.inner().kobj_common.kobj_type
  597. }
  598. fn name(&self) -> String {
  599. self.iface_name.clone()
  600. }
  601. fn set_name(&self, _name: String) {
  602. // do nothing
  603. }
  604. fn kobj_state(&self) -> RwLockReadGuard<'_, KObjectState> {
  605. self.locked_kobj_state.read()
  606. }
  607. fn kobj_state_mut(&self) -> RwLockWriteGuard<'_, KObjectState> {
  608. self.locked_kobj_state.write()
  609. }
  610. fn set_kobj_state(&self, state: KObjectState) {
  611. *self.locked_kobj_state.write() = state;
  612. }
  613. fn set_kobj_type(&self, ktype: Option<&'static dyn KObjType>) {
  614. self.inner().kobj_common.kobj_type = ktype;
  615. }
  616. }
  617. #[unified_init(INITCALL_POSTCORE)]
  618. fn virtio_net_driver_init() -> Result<(), SystemError> {
  619. let driver = VirtIONetDriver::new();
  620. virtio_driver_manager().register(driver.clone() as Arc<dyn VirtIODriver>)?;
  621. unsafe {
  622. VIRTIO_NET_DRIVER = Some(driver);
  623. }
  624. return Ok(());
  625. }
  626. #[derive(Debug)]
  627. #[cast_to([sync] VirtIODriver)]
  628. #[cast_to([sync] Driver)]
  629. struct VirtIONetDriver {
  630. inner: SpinLock<InnerVirtIODriver>,
  631. kobj_state: LockedKObjectState,
  632. }
  633. impl VirtIONetDriver {
  634. pub fn new() -> Arc<Self> {
  635. let inner = InnerVirtIODriver {
  636. virtio_driver_common: VirtIODriverCommonData::default(),
  637. driver_common: DriverCommonData::default(),
  638. kobj_common: KObjectCommonData::default(),
  639. };
  640. let id_table = VirtioDeviceId::new(
  641. virtio_drivers::transport::DeviceType::Network as u32,
  642. VIRTIO_VENDOR_ID.into(),
  643. );
  644. let result = VirtIONetDriver {
  645. inner: SpinLock::new(inner),
  646. kobj_state: LockedKObjectState::default(),
  647. };
  648. result.add_virtio_id(id_table);
  649. return Arc::new(result);
  650. }
  651. fn inner(&self) -> SpinLockGuard<'_, InnerVirtIODriver> {
  652. return self.inner.lock();
  653. }
  654. }
  655. #[derive(Debug)]
  656. struct InnerVirtIODriver {
  657. virtio_driver_common: VirtIODriverCommonData,
  658. driver_common: DriverCommonData,
  659. kobj_common: KObjectCommonData,
  660. }
  661. impl VirtIODriver for VirtIONetDriver {
  662. fn probe(&self, device: &Arc<dyn VirtIODevice>) -> Result<(), SystemError> {
  663. log::debug!("VirtIONetDriver::probe()");
  664. let virtio_net_device = device
  665. .clone()
  666. .arc_any()
  667. .downcast::<VirtIONetDevice>()
  668. .map_err(|_| {
  669. error!(
  670. "VirtIONetDriver::probe() failed: device is not a VirtIODevice. Device: '{:?}'",
  671. device.name()
  672. );
  673. SystemError::EINVAL
  674. })?;
  675. let iface: Arc<VirtioInterface> =
  676. VirtioInterface::new(virtio_net_device.inner().device_inner.clone());
  677. // 标识网络设备已经启动
  678. iface.set_net_state(NetDeivceState::__LINK_STATE_START);
  679. // 设置iface的父设备为virtio_net_device
  680. iface.set_dev_parent(Some(Arc::downgrade(&virtio_net_device) as Weak<dyn Device>));
  681. // 在sysfs中注册iface
  682. register_netdevice(iface.clone() as Arc<dyn Iface>)?;
  683. // 将网卡的接口信息注册到全局的网卡接口信息表中
  684. NET_DEVICES
  685. .write_irqsave()
  686. .insert(iface.nic_id(), iface.clone());
  687. virtio_irq_manager()
  688. .register_device(device.clone())
  689. .expect("Register virtio net irq failed");
  690. return Ok(());
  691. }
  692. fn virtio_id_table(&self) -> Vec<VirtioDeviceId> {
  693. self.inner().virtio_driver_common.id_table.clone()
  694. }
  695. fn add_virtio_id(&self, id: VirtioDeviceId) {
  696. self.inner().virtio_driver_common.id_table.push(id);
  697. }
  698. }
  699. impl Driver for VirtIONetDriver {
  700. fn id_table(&self) -> Option<IdTable> {
  701. Some(IdTable::new(VIRTIO_NET_BASENAME.to_string(), None))
  702. }
  703. fn add_device(&self, device: Arc<dyn Device>) {
  704. let virtio_net_device = device
  705. .arc_any()
  706. .downcast::<VirtIONetDevice>()
  707. .expect("VirtIONetDriver::add_device() failed: device is not a VirtioInterface");
  708. self.inner()
  709. .driver_common
  710. .devices
  711. .push(virtio_net_device as Arc<dyn Device>);
  712. }
  713. fn delete_device(&self, device: &Arc<dyn Device>) {
  714. let _virtio_net_device = device
  715. .clone()
  716. .arc_any()
  717. .downcast::<VirtIONetDevice>()
  718. .expect("VirtIONetDriver::delete_device() failed: device is not a VirtioInterface");
  719. let mut guard = self.inner();
  720. let index = guard
  721. .driver_common
  722. .devices
  723. .iter()
  724. .position(|dev| Arc::ptr_eq(device, dev))
  725. .expect("VirtIONetDriver::delete_device() failed: device not found");
  726. guard.driver_common.devices.remove(index);
  727. }
  728. fn devices(&self) -> Vec<Arc<dyn Device>> {
  729. self.inner().driver_common.devices.clone()
  730. }
  731. fn bus(&self) -> Option<Weak<dyn Bus>> {
  732. Some(Arc::downgrade(&virtio_bus()) as Weak<dyn Bus>)
  733. }
  734. fn set_bus(&self, _bus: Option<Weak<dyn Bus>>) {
  735. // do nothing
  736. }
  737. }
  738. impl KObject for VirtIONetDriver {
  739. fn as_any_ref(&self) -> &dyn Any {
  740. self
  741. }
  742. fn set_inode(&self, inode: Option<Arc<KernFSInode>>) {
  743. self.inner().kobj_common.kern_inode = inode;
  744. }
  745. fn inode(&self) -> Option<Arc<KernFSInode>> {
  746. self.inner().kobj_common.kern_inode.clone()
  747. }
  748. fn parent(&self) -> Option<Weak<dyn KObject>> {
  749. self.inner().kobj_common.parent.clone()
  750. }
  751. fn set_parent(&self, parent: Option<Weak<dyn KObject>>) {
  752. self.inner().kobj_common.parent = parent;
  753. }
  754. fn kset(&self) -> Option<Arc<KSet>> {
  755. self.inner().kobj_common.kset.clone()
  756. }
  757. fn set_kset(&self, kset: Option<Arc<KSet>>) {
  758. self.inner().kobj_common.kset = kset;
  759. }
  760. fn kobj_type(&self) -> Option<&'static dyn KObjType> {
  761. self.inner().kobj_common.kobj_type
  762. }
  763. fn set_kobj_type(&self, ktype: Option<&'static dyn KObjType>) {
  764. self.inner().kobj_common.kobj_type = ktype;
  765. }
  766. fn name(&self) -> String {
  767. VIRTIO_NET_BASENAME.to_string()
  768. }
  769. fn set_name(&self, _name: String) {
  770. // do nothing
  771. }
  772. fn kobj_state(&self) -> RwLockReadGuard<'_, KObjectState> {
  773. self.kobj_state.read()
  774. }
  775. fn kobj_state_mut(&self) -> RwLockWriteGuard<'_, KObjectState> {
  776. self.kobj_state.write()
  777. }
  778. fn set_kobj_state(&self, state: KObjectState) {
  779. *self.kobj_state.write() = state;
  780. }
  781. }