virtio_net.rs 27 KB

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