You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

netvsc.c 22KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838
  1. /*
  2. * Copyright (C) 2014 Michael Brown <mbrown@fensystems.co.uk>.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License as
  6. * published by the Free Software Foundation; either version 2 of the
  7. * License, or (at your option) any later version.
  8. *
  9. * This program is distributed in the hope that it will be useful, but
  10. * WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  12. * General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * along with this program; if not, write to the Free Software
  16. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  17. * 02110-1301, USA.
  18. */
  19. FILE_LICENCE ( GPL2_OR_LATER );
  20. /** @file
  21. *
  22. * Hyper-V network virtual service client
  23. *
  24. * The network virtual service client (NetVSC) connects to the network
  25. * virtual service provider (NetVSP) via the Hyper-V virtual machine
  26. * bus (VMBus). It provides a transport layer for RNDIS packets.
  27. */
  28. #include <errno.h>
  29. #include <unistd.h>
  30. #include <byteswap.h>
  31. #include <ipxe/umalloc.h>
  32. #include <ipxe/rndis.h>
  33. #include <ipxe/vmbus.h>
  34. #include "netvsc.h"
  35. /**
  36. * Send control message and wait for completion
  37. *
  38. * @v netvsc NetVSC device
  39. * @v xrid Relative transaction ID
  40. * @v data Data
  41. * @v len Length of data
  42. * @ret rc Return status code
  43. */
  44. static int netvsc_control ( struct netvsc_device *netvsc, unsigned int xrid,
  45. const void *data, size_t len ) {
  46. uint64_t xid = ( NETVSC_BASE_XID + xrid );
  47. unsigned int i;
  48. int rc;
  49. /* Send control message */
  50. if ( ( rc = vmbus_send_control ( netvsc->vmdev, xid, data, len ) ) !=0){
  51. DBGC ( netvsc, "NETVSC %s could not send control message: %s\n",
  52. netvsc->name, strerror ( rc ) );
  53. return rc;
  54. }
  55. /* Record transaction ID */
  56. netvsc->wait_xrid = xrid;
  57. /* Wait for operation to complete */
  58. for ( i = 0 ; i < NETVSC_MAX_WAIT_MS ; i++ ) {
  59. /* Check for completion */
  60. if ( ! netvsc->wait_xrid )
  61. return netvsc->wait_rc;
  62. /* Poll VMBus device */
  63. vmbus_poll ( netvsc->vmdev );
  64. /* Delay for 1ms */
  65. mdelay ( 1 );
  66. }
  67. DBGC ( netvsc, "NETVSC %s timed out waiting for XRID %d\n",
  68. netvsc->name, xrid );
  69. vmbus_dump_channel ( netvsc->vmdev );
  70. return -ETIMEDOUT;
  71. }
  72. /**
  73. * Handle generic completion
  74. *
  75. * @v netvsc NetVSC device
  76. * @v data Data
  77. * @v len Length of data
  78. * @ret rc Return status code
  79. */
  80. static int netvsc_completed ( struct netvsc_device *netvsc __unused,
  81. const void *data __unused, size_t len __unused ) {
  82. return 0;
  83. }
  84. /**
  85. * Initialise communication
  86. *
  87. * @v netvsc NetVSC device
  88. * @ret rc Return status code
  89. */
  90. static int netvsc_initialise ( struct netvsc_device *netvsc ) {
  91. struct netvsc_init_message msg;
  92. int rc;
  93. /* Construct message */
  94. memset ( &msg, 0, sizeof ( msg ) );
  95. msg.header.type = cpu_to_le32 ( NETVSC_INIT_MSG );
  96. msg.min = cpu_to_le32 ( NETVSC_VERSION_1 );
  97. msg.max = cpu_to_le32 ( NETVSC_VERSION_1 );
  98. /* Send message and wait for completion */
  99. if ( ( rc = netvsc_control ( netvsc, NETVSC_INIT_XRID, &msg,
  100. sizeof ( msg ) ) ) != 0 ) {
  101. DBGC ( netvsc, "NETVSC %s could not initialise: %s\n",
  102. netvsc->name, strerror ( rc ) );
  103. return rc;
  104. }
  105. return 0;
  106. }
  107. /**
  108. * Handle initialisation completion
  109. *
  110. * @v netvsc NetVSC device
  111. * @v data Data
  112. * @v len Length of data
  113. * @ret rc Return status code
  114. */
  115. static int
  116. netvsc_initialised ( struct netvsc_device *netvsc, const void *data,
  117. size_t len ) {
  118. const struct netvsc_init_completion *cmplt = data;
  119. /* Check completion */
  120. if ( len < sizeof ( *cmplt ) ) {
  121. DBGC ( netvsc, "NETVSC %s underlength initialisation "
  122. "completion (%zd bytes)\n", netvsc->name, len );
  123. return -EINVAL;
  124. }
  125. if ( cmplt->header.type != cpu_to_le32 ( NETVSC_INIT_CMPLT ) ) {
  126. DBGC ( netvsc, "NETVSC %s unexpected initialisation completion "
  127. "type %d\n", netvsc->name,
  128. le32_to_cpu ( cmplt->header.type ) );
  129. return -EPROTO;
  130. }
  131. if ( cmplt->status != cpu_to_le32 ( NETVSC_OK ) ) {
  132. DBGC ( netvsc, "NETVSC %s initialisation failure status %d\n",
  133. netvsc->name, le32_to_cpu ( cmplt->status ) );
  134. return -EPROTO;
  135. }
  136. return 0;
  137. }
  138. /**
  139. * Set NDIS version
  140. *
  141. * @v netvsc NetVSC device
  142. * @ret rc Return status code
  143. */
  144. static int netvsc_ndis_version ( struct netvsc_device *netvsc ) {
  145. struct netvsc_ndis_version_message msg;
  146. int rc;
  147. /* Construct message */
  148. memset ( &msg, 0, sizeof ( msg ) );
  149. msg.header.type = cpu_to_le32 ( NETVSC_NDIS_VERSION_MSG );
  150. msg.major = cpu_to_le32 ( NETVSC_NDIS_MAJOR );
  151. msg.minor = cpu_to_le32 ( NETVSC_NDIS_MINOR );
  152. /* Send message and wait for completion */
  153. if ( ( rc = netvsc_control ( netvsc, NETVSC_NDIS_VERSION_XRID,
  154. &msg, sizeof ( msg ) ) ) != 0 ) {
  155. DBGC ( netvsc, "NETVSC %s could not set NDIS version: %s\n",
  156. netvsc->name, strerror ( rc ) );
  157. return rc;
  158. }
  159. return 0;
  160. }
  161. /**
  162. * Establish data buffer
  163. *
  164. * @v netvsc NetVSC device
  165. * @v buffer Data buffer
  166. * @ret rc Return status code
  167. */
  168. static int netvsc_establish_buffer ( struct netvsc_device *netvsc,
  169. struct netvsc_buffer *buffer ) {
  170. struct netvsc_establish_buffer_message msg;
  171. int rc;
  172. /* Construct message */
  173. memset ( &msg, 0, sizeof ( msg ) );
  174. msg.header.type = cpu_to_le32 ( buffer->establish_type );
  175. msg.gpadl = cpu_to_le32 ( buffer->gpadl );
  176. msg.pageset = buffer->pages.pageset; /* Already protocol-endian */
  177. /* Send message and wait for completion */
  178. if ( ( rc = netvsc_control ( netvsc, buffer->establish_xrid, &msg,
  179. sizeof ( msg ) ) ) != 0 ) {
  180. DBGC ( netvsc, "NETVSC %s could not establish buffer: %s\n",
  181. netvsc->name, strerror ( rc ) );
  182. return rc;
  183. }
  184. return 0;
  185. }
  186. /**
  187. * Handle establish receive data buffer completion
  188. *
  189. * @v netvsc NetVSC device
  190. * @v data Data
  191. * @v len Length of data
  192. * @ret rc Return status code
  193. */
  194. static int netvsc_rx_established_buffer ( struct netvsc_device *netvsc,
  195. const void *data, size_t len ) {
  196. const struct netvsc_rx_establish_buffer_completion *cmplt = data;
  197. /* Check completion */
  198. if ( len < sizeof ( *cmplt ) ) {
  199. DBGC ( netvsc, "NETVSC %s underlength buffer completion (%zd "
  200. "bytes)\n", netvsc->name, len );
  201. return -EINVAL;
  202. }
  203. if ( cmplt->header.type != cpu_to_le32 ( NETVSC_RX_ESTABLISH_CMPLT ) ) {
  204. DBGC ( netvsc, "NETVSC %s unexpected buffer completion type "
  205. "%d\n", netvsc->name, le32_to_cpu ( cmplt->header.type));
  206. return -EPROTO;
  207. }
  208. if ( cmplt->status != cpu_to_le32 ( NETVSC_OK ) ) {
  209. DBGC ( netvsc, "NETVSC %s buffer failure status %d\n",
  210. netvsc->name, le32_to_cpu ( cmplt->status ) );
  211. return -EPROTO;
  212. }
  213. return 0;
  214. }
  215. /**
  216. * Revoke data buffer
  217. *
  218. * @v netvsc NetVSC device
  219. * @v buffer Data buffer
  220. * @ret rc Return status code
  221. */
  222. static int netvsc_revoke_buffer ( struct netvsc_device *netvsc,
  223. struct netvsc_buffer *buffer ) {
  224. struct netvsc_revoke_buffer_message msg;
  225. int rc;
  226. /* Construct message */
  227. memset ( &msg, 0, sizeof ( msg ) );
  228. msg.header.type = cpu_to_le32 ( buffer->revoke_type );
  229. msg.pageset = buffer->pages.pageset; /* Already protocol-endian */
  230. /* Send message and wait for completion */
  231. if ( ( rc = netvsc_control ( netvsc, buffer->revoke_xrid,
  232. &msg, sizeof ( msg ) ) ) != 0 )
  233. return rc;
  234. return 0;
  235. }
  236. /**
  237. * Handle received control packet
  238. *
  239. * @v vmdev VMBus device
  240. * @v xid Transaction ID
  241. * @v data Data
  242. * @v len Length of data
  243. * @ret rc Return status code
  244. */
  245. static int netvsc_recv_control ( struct vmbus_device *vmdev, uint64_t xid,
  246. const void *data, size_t len ) {
  247. struct rndis_device *rndis = vmbus_get_drvdata ( vmdev );
  248. struct netvsc_device *netvsc = rndis->priv;
  249. DBGC ( netvsc, "NETVSC %s received unsupported control packet "
  250. "(%08llx):\n", netvsc->name, xid );
  251. DBGC_HDA ( netvsc, 0, data, len );
  252. return -ENOTSUP;
  253. }
  254. /**
  255. * Handle received data packet
  256. *
  257. * @v vmdev VMBus device
  258. * @v xid Transaction ID
  259. * @v data Data
  260. * @v len Length of data
  261. * @v iobuf I/O buffer, or NULL if allocation failed
  262. * @ret rc Return status code
  263. */
  264. static int netvsc_recv_data ( struct vmbus_device *vmdev, uint64_t xid,
  265. const void *data, size_t len,
  266. struct io_buffer *iobuf ) {
  267. struct rndis_device *rndis = vmbus_get_drvdata ( vmdev );
  268. struct netvsc_device *netvsc = rndis->priv;
  269. const struct netvsc_rndis_message *msg = data;
  270. int rc;
  271. /* Sanity check */
  272. if ( len < sizeof ( *msg ) ) {
  273. DBGC ( netvsc, "NETVSC %s received underlength RNDIS packet "
  274. "(%zd bytes)\n", netvsc->name, len );
  275. rc = -EINVAL;
  276. goto err_sanity;
  277. }
  278. if ( msg->header.type != cpu_to_le32 ( NETVSC_RNDIS_MSG ) ) {
  279. DBGC ( netvsc, "NETVSC %s received unexpected RNDIS packet "
  280. "type %d\n", netvsc->name,
  281. le32_to_cpu ( msg->header.type ) );
  282. rc = -EINVAL;
  283. goto err_sanity;
  284. }
  285. /* Send completion back to host (even if I/O buffer was missing) */
  286. if ( ( rc = vmbus_send_completion ( vmdev, xid, NULL, 0 ) ) != 0 ) {
  287. DBGC ( netvsc, "NETVSC %s could not send completion: %s\n",
  288. netvsc->name, strerror ( rc ) );
  289. goto err_completion;
  290. }
  291. /* Hand off to RNDIS (even if I/O buffer was missing) */
  292. rndis_rx ( rndis, iob_disown ( iobuf ) );
  293. return 0;
  294. err_completion:
  295. err_sanity:
  296. free_iob ( iobuf );
  297. return rc;
  298. }
  299. /**
  300. * Handle received completion packet
  301. *
  302. * @v vmdev VMBus device
  303. * @v xid Transaction ID
  304. * @v data Data
  305. * @v len Length of data
  306. * @ret rc Return status code
  307. */
  308. static int netvsc_recv_completion ( struct vmbus_device *vmdev, uint64_t xid,
  309. const void *data, size_t len ) {
  310. struct rndis_device *rndis = vmbus_get_drvdata ( vmdev );
  311. struct netvsc_device *netvsc = rndis->priv;
  312. struct io_buffer *iobuf;
  313. int ( * completion ) ( struct netvsc_device *netvsc,
  314. const void *data, size_t len );
  315. unsigned int xrid = ( xid - NETVSC_BASE_XID );
  316. unsigned int tx_id;
  317. int rc;
  318. /* Handle transmit completion, if applicable */
  319. tx_id = ( xrid - NETVSC_TX_BASE_XRID );
  320. if ( ( tx_id < NETVSC_TX_NUM_DESC ) &&
  321. ( ( iobuf = netvsc->tx.iobufs[tx_id] ) != NULL ) ) {
  322. /* Free buffer ID */
  323. netvsc->tx.iobufs[tx_id] = NULL;
  324. netvsc->tx.ids[ ( netvsc->tx.id_cons++ ) &
  325. ( netvsc->tx.count - 1 ) ] = tx_id;
  326. /* Hand back to RNDIS */
  327. rndis_tx_complete ( rndis, iobuf );
  328. return 0;
  329. }
  330. /* Otherwise determine completion handler */
  331. if ( xrid == NETVSC_INIT_XRID ) {
  332. completion = netvsc_initialised;
  333. } else if ( xrid == NETVSC_RX_ESTABLISH_XRID ) {
  334. completion = netvsc_rx_established_buffer;
  335. } else if ( ( netvsc->wait_xrid != 0 ) &&
  336. ( xrid == netvsc->wait_xrid ) ) {
  337. completion = netvsc_completed;
  338. } else {
  339. DBGC ( netvsc, "NETVSC %s received unexpected completion "
  340. "(%08llx)\n", netvsc->name, xid );
  341. return -EPIPE;
  342. }
  343. /* Hand off to completion handler */
  344. rc = completion ( netvsc, data, len );
  345. /* Record completion handler result if applicable */
  346. if ( xrid == netvsc->wait_xrid ) {
  347. netvsc->wait_xrid = 0;
  348. netvsc->wait_rc = rc;
  349. }
  350. return rc;
  351. }
  352. /**
  353. * Handle received cancellation packet
  354. *
  355. * @v vmdev VMBus device
  356. * @v xid Transaction ID
  357. * @ret rc Return status code
  358. */
  359. static int netvsc_recv_cancellation ( struct vmbus_device *vmdev,
  360. uint64_t xid ) {
  361. struct rndis_device *rndis = vmbus_get_drvdata ( vmdev );
  362. struct netvsc_device *netvsc = rndis->priv;
  363. DBGC ( netvsc, "NETVSC %s received unsupported cancellation packet "
  364. "(%08llx):\n", netvsc->name, xid );
  365. return -ENOTSUP;
  366. }
  367. /** VMBus channel operations */
  368. static struct vmbus_channel_operations netvsc_channel_operations = {
  369. .recv_control = netvsc_recv_control,
  370. .recv_data = netvsc_recv_data,
  371. .recv_completion = netvsc_recv_completion,
  372. .recv_cancellation = netvsc_recv_cancellation,
  373. };
  374. /**
  375. * Poll for completed and received packets
  376. *
  377. * @v rndis RNDIS device
  378. */
  379. static void netvsc_poll ( struct rndis_device *rndis ) {
  380. struct netvsc_device *netvsc = rndis->priv;
  381. /* Poll VMBus device */
  382. vmbus_poll ( netvsc->vmdev );
  383. }
  384. /**
  385. * Transmit packet
  386. *
  387. * @v rndis RNDIS device
  388. * @v iobuf I/O buffer
  389. * @ret rc Return status code
  390. *
  391. * If this method returns success then the RNDIS device must
  392. * eventually report completion via rndis_tx_complete().
  393. */
  394. static int netvsc_transmit ( struct rndis_device *rndis,
  395. struct io_buffer *iobuf ) {
  396. struct netvsc_device *netvsc = rndis->priv;
  397. struct rndis_header *header = iobuf->data;
  398. struct netvsc_rndis_message msg;
  399. unsigned int tx_id;
  400. unsigned int xrid;
  401. uint64_t xid;
  402. int rc;
  403. /* Sanity check */
  404. assert ( iob_len ( iobuf ) >= sizeof ( *header ) );
  405. assert ( iob_len ( iobuf ) == le32_to_cpu ( header->len ) );
  406. /* Check that we have space in the transmit ring */
  407. if ( netvsc_ring_is_full ( &netvsc->tx ) )
  408. return rndis_tx_defer ( rndis, iobuf );
  409. /* Allocate buffer ID and calculate transaction ID */
  410. tx_id = netvsc->tx.ids[ netvsc->tx.id_prod & ( netvsc->tx.count - 1 ) ];
  411. assert ( netvsc->tx.iobufs[tx_id] == NULL );
  412. xrid = ( NETVSC_TX_BASE_XRID + tx_id );
  413. xid = ( NETVSC_BASE_XID + xrid );
  414. /* Construct message */
  415. memset ( &msg, 0, sizeof ( msg ) );
  416. msg.header.type = cpu_to_le32 ( NETVSC_RNDIS_MSG );
  417. msg.channel = ( ( header->type == cpu_to_le32 ( RNDIS_PACKET_MSG ) ) ?
  418. NETVSC_RNDIS_DATA : NETVSC_RNDIS_CONTROL );
  419. msg.buffer = cpu_to_le32 ( NETVSC_RNDIS_NO_BUFFER );
  420. /* Send message */
  421. if ( ( rc = vmbus_send_data ( netvsc->vmdev, xid, &msg, sizeof ( msg ),
  422. iobuf ) ) != 0 ) {
  423. DBGC ( netvsc, "NETVSC %s could not send RNDIS message: %s\n",
  424. netvsc->name, strerror ( rc ) );
  425. return rc;
  426. }
  427. /* Store I/O buffer and consume buffer ID */
  428. netvsc->tx.iobufs[tx_id] = iobuf;
  429. netvsc->tx.id_prod++;
  430. return 0;
  431. }
  432. /**
  433. * Cancel transmission
  434. *
  435. * @v netvsc NetVSC device
  436. * @v iobuf I/O buffer
  437. * @v tx_id Transmission ID
  438. */
  439. static void netvsc_cancel_transmit ( struct netvsc_device *netvsc,
  440. struct io_buffer *iobuf,
  441. unsigned int tx_id ) {
  442. unsigned int xrid;
  443. uint64_t xid;
  444. /* Send cancellation */
  445. xrid = ( NETVSC_TX_BASE_XRID + tx_id );
  446. xid = ( NETVSC_BASE_XID + xrid );
  447. DBGC ( netvsc, "NETVSC %s cancelling transmission %#x\n",
  448. netvsc->name, tx_id );
  449. vmbus_send_cancellation ( netvsc->vmdev, xid );
  450. /* Report back to RNDIS */
  451. rndis_tx_complete_err ( netvsc->rndis, iobuf, -ECANCELED );
  452. }
  453. /**
  454. * Create descriptor ring
  455. *
  456. * @v netvsc NetVSC device
  457. * @v ring Descriptor ring
  458. * @ret rc Return status code
  459. */
  460. static int netvsc_create_ring ( struct netvsc_device *netvsc __unused,
  461. struct netvsc_ring *ring ) {
  462. unsigned int i;
  463. /* Initialise buffer ID ring */
  464. for ( i = 0 ; i < ring->count ; i++ ) {
  465. ring->ids[i] = i;
  466. assert ( ring->iobufs[i] == NULL );
  467. }
  468. ring->id_prod = 0;
  469. ring->id_cons = 0;
  470. return 0;
  471. }
  472. /**
  473. * Destroy descriptor ring
  474. *
  475. * @v netvsc NetVSC device
  476. * @v ring Descriptor ring
  477. * @v discard Method used to discard outstanding buffer, or NULL
  478. */
  479. static void netvsc_destroy_ring ( struct netvsc_device *netvsc,
  480. struct netvsc_ring *ring,
  481. void ( * discard ) ( struct netvsc_device *,
  482. struct io_buffer *,
  483. unsigned int ) ) {
  484. struct io_buffer *iobuf;
  485. unsigned int i;
  486. /* Flush any outstanding buffers */
  487. for ( i = 0 ; i < ring->count ; i++ ) {
  488. iobuf = ring->iobufs[i];
  489. if ( ! iobuf )
  490. continue;
  491. ring->iobufs[i] = NULL;
  492. ring->ids[ ( ring->id_cons++ ) & ( ring->count - 1 ) ] = i;
  493. if ( discard )
  494. discard ( netvsc, iobuf, i );
  495. }
  496. /* Sanity check */
  497. assert ( netvsc_ring_is_empty ( ring ) );
  498. }
  499. /**
  500. * Copy data from data buffer
  501. *
  502. * @v pages Transfer page set
  503. * @v data Data buffer
  504. * @v offset Offset within page set
  505. * @v len Length within page set
  506. * @ret rc Return status code
  507. */
  508. static int netvsc_buffer_copy ( struct vmbus_xfer_pages *pages, void *data,
  509. size_t offset, size_t len ) {
  510. struct netvsc_buffer *buffer =
  511. container_of ( pages, struct netvsc_buffer, pages );
  512. /* Sanity check */
  513. if ( ( offset > buffer->len ) || ( len > ( buffer->len - offset ) ) )
  514. return -ERANGE;
  515. /* Copy data from buffer */
  516. copy_from_user ( data, buffer->data, offset, len );
  517. return 0;
  518. }
  519. /** Transfer page set operations */
  520. static struct vmbus_xfer_pages_operations netvsc_xfer_pages_operations = {
  521. .copy = netvsc_buffer_copy,
  522. };
  523. /**
  524. * Create data buffer
  525. *
  526. * @v netvsc NetVSC device
  527. * @v buffer Data buffer
  528. * @ret rc Return status code
  529. */
  530. static int netvsc_create_buffer ( struct netvsc_device *netvsc,
  531. struct netvsc_buffer *buffer ) {
  532. struct vmbus_device *vmdev = netvsc->vmdev;
  533. int gpadl;
  534. int rc;
  535. /* Allocate receive buffer */
  536. buffer->data = umalloc ( buffer->len );
  537. if ( ! buffer->data ) {
  538. DBGC ( netvsc, "NETVSC %s could not allocate %zd-byte buffer\n",
  539. netvsc->name, buffer->len );
  540. rc = -ENOMEM;
  541. goto err_alloc;
  542. }
  543. /* Establish GPA descriptor list */
  544. gpadl = vmbus_establish_gpadl ( vmdev, buffer->data, buffer->len );
  545. if ( gpadl < 0 ) {
  546. rc = gpadl;
  547. DBGC ( netvsc, "NETVSC %s could not establish GPADL: %s\n",
  548. netvsc->name, strerror ( rc ) );
  549. goto err_establish_gpadl;
  550. }
  551. buffer->gpadl = gpadl;
  552. /* Register transfer page set */
  553. if ( ( rc = vmbus_register_pages ( vmdev, &buffer->pages ) ) != 0 ) {
  554. DBGC ( netvsc, "NETVSC %s could not register transfer pages: "
  555. "%s\n", netvsc->name, strerror ( rc ) );
  556. goto err_register_pages;
  557. }
  558. /* Establish data buffer */
  559. if ( ( rc = netvsc_establish_buffer ( netvsc, buffer ) ) != 0 )
  560. goto err_establish_buffer;
  561. return 0;
  562. netvsc_revoke_buffer ( netvsc, buffer );
  563. err_establish_buffer:
  564. vmbus_unregister_pages ( vmdev, &buffer->pages );
  565. err_register_pages:
  566. vmbus_gpadl_teardown ( vmdev, gpadl );
  567. err_establish_gpadl:
  568. ufree ( buffer->data );
  569. err_alloc:
  570. return rc;
  571. }
  572. /**
  573. * Destroy data buffer
  574. *
  575. * @v netvsc NetVSC device
  576. * @v buffer Data buffer
  577. */
  578. static void netvsc_destroy_buffer ( struct netvsc_device *netvsc,
  579. struct netvsc_buffer *buffer ) {
  580. struct vmbus_device *vmdev = netvsc->vmdev;
  581. int rc;
  582. /* Revoke buffer */
  583. if ( ( rc = netvsc_revoke_buffer ( netvsc, buffer ) ) != 0 ) {
  584. DBGC ( netvsc, "NETVSC %s could not revoke buffer: %s\n",
  585. netvsc->name, strerror ( rc ) );
  586. /* Continue to attempt to tear down the GPA descriptor
  587. * list, which should forcibly prevent the host from
  588. * subsequently accessing this memory.
  589. */
  590. }
  591. /* Unregister transfer pages */
  592. vmbus_unregister_pages ( vmdev, &buffer->pages );
  593. /* Tear down GPA descriptor list */
  594. if ( ( rc = vmbus_gpadl_teardown ( vmdev, buffer->gpadl ) ) != 0 ) {
  595. DBGC ( netvsc, "NETVSC %s could not tear down GPADL: %s\n",
  596. netvsc->name, strerror ( rc ) );
  597. /* Death is imminent. The host may well continue to
  598. * write to the data buffer. The best we can do is
  599. * leak memory for now and hope that the host doesn't
  600. * write to this region after we load an OS.
  601. */
  602. return;
  603. }
  604. /* Free buffer */
  605. ufree ( buffer->data );
  606. }
  607. /**
  608. * Open device
  609. *
  610. * @v rndis RNDIS device
  611. * @ret rc Return status code
  612. */
  613. static int netvsc_open ( struct rndis_device *rndis ) {
  614. struct netvsc_device *netvsc = rndis->priv;
  615. int rc;
  616. /* Open channel */
  617. if ( ( rc = vmbus_open ( netvsc->vmdev, &netvsc_channel_operations,
  618. PAGE_SIZE, PAGE_SIZE, NETVSC_MTU ) ) != 0 ) {
  619. DBGC ( netvsc, "NETVSC %s could not open VMBus: %s\n",
  620. netvsc->name, strerror ( rc ) );
  621. goto err_vmbus_open;
  622. }
  623. /* Initialise communication with NetVSP */
  624. if ( ( rc = netvsc_initialise ( netvsc ) ) != 0 )
  625. goto err_initialise;
  626. if ( ( rc = netvsc_ndis_version ( netvsc ) ) != 0 )
  627. goto err_ndis_version;
  628. /* Initialise transmit ring */
  629. if ( ( rc = netvsc_create_ring ( netvsc, &netvsc->tx ) ) != 0 )
  630. goto err_create_tx;
  631. /* Initialise receive buffer */
  632. if ( ( rc = netvsc_create_buffer ( netvsc, &netvsc->rx ) ) != 0 )
  633. goto err_create_rx;
  634. return 0;
  635. netvsc_destroy_buffer ( netvsc, &netvsc->rx );
  636. err_create_rx:
  637. netvsc_destroy_ring ( netvsc, &netvsc->tx, NULL );
  638. err_create_tx:
  639. err_ndis_version:
  640. err_initialise:
  641. vmbus_close ( netvsc->vmdev );
  642. err_vmbus_open:
  643. return rc;
  644. }
  645. /**
  646. * Close device
  647. *
  648. * @v rndis RNDIS device
  649. */
  650. static void netvsc_close ( struct rndis_device *rndis ) {
  651. struct netvsc_device *netvsc = rndis->priv;
  652. /* Destroy receive buffer */
  653. netvsc_destroy_buffer ( netvsc, &netvsc->rx );
  654. /* Destroy transmit ring */
  655. netvsc_destroy_ring ( netvsc, &netvsc->tx, netvsc_cancel_transmit );
  656. /* Close channel */
  657. vmbus_close ( netvsc->vmdev );
  658. }
  659. /** RNDIS operations */
  660. static struct rndis_operations netvsc_operations = {
  661. .open = netvsc_open,
  662. .close = netvsc_close,
  663. .transmit = netvsc_transmit,
  664. .poll = netvsc_poll,
  665. };
  666. /**
  667. * Probe device
  668. *
  669. * @v vmdev VMBus device
  670. * @ret rc Return status code
  671. */
  672. static int netvsc_probe ( struct vmbus_device *vmdev ) {
  673. struct netvsc_device *netvsc;
  674. struct rndis_device *rndis;
  675. int rc;
  676. /* Allocate and initialise structure */
  677. rndis = alloc_rndis ( sizeof ( *netvsc ) );
  678. if ( ! rndis ) {
  679. rc = -ENOMEM;
  680. goto err_alloc;
  681. }
  682. rndis_init ( rndis, &netvsc_operations );
  683. rndis->netdev->dev = &vmdev->dev;
  684. netvsc = rndis->priv;
  685. netvsc->vmdev = vmdev;
  686. netvsc->rndis = rndis;
  687. netvsc->name = vmdev->dev.name;
  688. netvsc_init_ring ( &netvsc->tx, NETVSC_TX_NUM_DESC,
  689. netvsc->tx_iobufs, netvsc->tx_ids );
  690. netvsc_init_buffer ( &netvsc->rx, NETVSC_RX_BUF_PAGESET,
  691. &netvsc_xfer_pages_operations,
  692. NETVSC_RX_ESTABLISH_MSG, NETVSC_RX_ESTABLISH_XRID,
  693. NETVSC_RX_REVOKE_MSG, NETVSC_RX_REVOKE_XRID,
  694. NETVSC_RX_BUF_LEN );
  695. vmbus_set_drvdata ( vmdev, rndis );
  696. /* Register RNDIS device */
  697. if ( ( rc = register_rndis ( rndis ) ) != 0 ) {
  698. DBGC ( netvsc, "NETVSC %s could not register: %s\n",
  699. netvsc->name, strerror ( rc ) );
  700. goto err_register;
  701. }
  702. return 0;
  703. unregister_rndis ( rndis );
  704. err_register:
  705. free_rndis ( rndis );
  706. err_alloc:
  707. return rc;
  708. }
  709. /**
  710. * Remove device
  711. *
  712. * @v vmdev VMBus device
  713. */
  714. static void netvsc_remove ( struct vmbus_device *vmdev ) {
  715. struct rndis_device *rndis = vmbus_get_drvdata ( vmdev );
  716. /* Unregister RNDIS device */
  717. unregister_rndis ( rndis );
  718. /* Free RNDIS device */
  719. free_rndis ( rndis );
  720. }
  721. /** NetVSC driver */
  722. struct vmbus_driver netvsc_driver __vmbus_driver = {
  723. .name = "netvsc",
  724. .type = VMBUS_TYPE ( 0xf8615163, 0xdf3e, 0x46c5, 0x913f,
  725. 0xf2, 0xd2, 0xf9, 0x65, 0xed, 0x0e ),
  726. .probe = netvsc_probe,
  727. .remove = netvsc_remove,
  728. };