virtio_net.rs 28 KB

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