xen-netfront.c 45 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824
  1. /*
  2. * Virtual network driver for conversing with remote driver backends.
  3. *
  4. * Copyright (c) 2002-2005, K A Fraser
  5. * Copyright (c) 2005, XenSource Ltd
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License version 2
  9. * as published by the Free Software Foundation; or, when distributed
  10. * separately from the Linux kernel or incorporated into other
  11. * software packages, subject to the following license:
  12. *
  13. * Permission is hereby granted, free of charge, to any person obtaining a copy
  14. * of this source file (the "Software"), to deal in the Software without
  15. * restriction, including without limitation the rights to use, copy, modify,
  16. * merge, publish, distribute, sublicense, and/or sell copies of the Software,
  17. * and to permit persons to whom the Software is furnished to do so, subject to
  18. * the following conditions:
  19. *
  20. * The above copyright notice and this permission notice shall be included in
  21. * all copies or substantial portions of the Software.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  24. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  25. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  26. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  27. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  28. * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
  29. * IN THE SOFTWARE.
  30. */
  31. #include <linux/module.h>
  32. #include <linux/kernel.h>
  33. #include <linux/netdevice.h>
  34. #include <linux/etherdevice.h>
  35. #include <linux/skbuff.h>
  36. #include <linux/ethtool.h>
  37. #include <linux/if_ether.h>
  38. #include <linux/tcp.h>
  39. #include <linux/udp.h>
  40. #include <linux/moduleparam.h>
  41. #include <linux/mm.h>
  42. #include <net/ip.h>
  43. #include <xen/xenbus.h>
  44. #include <xen/events.h>
  45. #include <xen/page.h>
  46. #include <xen/grant_table.h>
  47. #include <xen/interface/io/netif.h>
  48. #include <xen/interface/memory.h>
  49. #include <xen/interface/grant_table.h>
  50. static struct ethtool_ops xennet_ethtool_ops;
  51. struct netfront_cb {
  52. struct page *page;
  53. unsigned offset;
  54. };
  55. #define NETFRONT_SKB_CB(skb) ((struct netfront_cb *)((skb)->cb))
  56. #define RX_COPY_THRESHOLD 256
  57. #define GRANT_INVALID_REF 0
  58. #define NET_TX_RING_SIZE __RING_SIZE((struct xen_netif_tx_sring *)0, PAGE_SIZE)
  59. #define NET_RX_RING_SIZE __RING_SIZE((struct xen_netif_rx_sring *)0, PAGE_SIZE)
  60. #define TX_MAX_TARGET min_t(int, NET_RX_RING_SIZE, 256)
  61. struct netfront_info {
  62. struct list_head list;
  63. struct net_device *netdev;
  64. struct napi_struct napi;
  65. unsigned int evtchn;
  66. struct xenbus_device *xbdev;
  67. spinlock_t tx_lock;
  68. struct xen_netif_tx_front_ring tx;
  69. int tx_ring_ref;
  70. /*
  71. * {tx,rx}_skbs store outstanding skbuffs. Free tx_skb entries
  72. * are linked from tx_skb_freelist through skb_entry.link.
  73. *
  74. * NB. Freelist index entries are always going to be less than
  75. * PAGE_OFFSET, whereas pointers to skbs will always be equal or
  76. * greater than PAGE_OFFSET: we use this property to distinguish
  77. * them.
  78. */
  79. union skb_entry {
  80. struct sk_buff *skb;
  81. unsigned long link;
  82. } tx_skbs[NET_TX_RING_SIZE];
  83. grant_ref_t gref_tx_head;
  84. grant_ref_t grant_tx_ref[NET_TX_RING_SIZE];
  85. unsigned tx_skb_freelist;
  86. spinlock_t rx_lock ____cacheline_aligned_in_smp;
  87. struct xen_netif_rx_front_ring rx;
  88. int rx_ring_ref;
  89. /* Receive-ring batched refills. */
  90. #define RX_MIN_TARGET 8
  91. #define RX_DFL_MIN_TARGET 64
  92. #define RX_MAX_TARGET min_t(int, NET_RX_RING_SIZE, 256)
  93. unsigned rx_min_target, rx_max_target, rx_target;
  94. struct sk_buff_head rx_batch;
  95. struct timer_list rx_refill_timer;
  96. struct sk_buff *rx_skbs[NET_RX_RING_SIZE];
  97. grant_ref_t gref_rx_head;
  98. grant_ref_t grant_rx_ref[NET_RX_RING_SIZE];
  99. unsigned long rx_pfn_array[NET_RX_RING_SIZE];
  100. struct multicall_entry rx_mcl[NET_RX_RING_SIZE+1];
  101. struct mmu_update rx_mmu[NET_RX_RING_SIZE];
  102. };
  103. struct netfront_rx_info {
  104. struct xen_netif_rx_response rx;
  105. struct xen_netif_extra_info extras[XEN_NETIF_EXTRA_TYPE_MAX - 1];
  106. };
  107. static void skb_entry_set_link(union skb_entry *list, unsigned short id)
  108. {
  109. list->link = id;
  110. }
  111. static int skb_entry_is_link(const union skb_entry *list)
  112. {
  113. BUILD_BUG_ON(sizeof(list->skb) != sizeof(list->link));
  114. return ((unsigned long)list->skb < PAGE_OFFSET);
  115. }
  116. /*
  117. * Access macros for acquiring freeing slots in tx_skbs[].
  118. */
  119. static void add_id_to_freelist(unsigned *head, union skb_entry *list,
  120. unsigned short id)
  121. {
  122. skb_entry_set_link(&list[id], *head);
  123. *head = id;
  124. }
  125. static unsigned short get_id_from_freelist(unsigned *head,
  126. union skb_entry *list)
  127. {
  128. unsigned int id = *head;
  129. *head = list[id].link;
  130. return id;
  131. }
  132. static int xennet_rxidx(RING_IDX idx)
  133. {
  134. return idx & (NET_RX_RING_SIZE - 1);
  135. }
  136. static struct sk_buff *xennet_get_rx_skb(struct netfront_info *np,
  137. RING_IDX ri)
  138. {
  139. int i = xennet_rxidx(ri);
  140. struct sk_buff *skb = np->rx_skbs[i];
  141. np->rx_skbs[i] = NULL;
  142. return skb;
  143. }
  144. static grant_ref_t xennet_get_rx_ref(struct netfront_info *np,
  145. RING_IDX ri)
  146. {
  147. int i = xennet_rxidx(ri);
  148. grant_ref_t ref = np->grant_rx_ref[i];
  149. np->grant_rx_ref[i] = GRANT_INVALID_REF;
  150. return ref;
  151. }
  152. #ifdef CONFIG_SYSFS
  153. static int xennet_sysfs_addif(struct net_device *netdev);
  154. static void xennet_sysfs_delif(struct net_device *netdev);
  155. #else /* !CONFIG_SYSFS */
  156. #define xennet_sysfs_addif(dev) (0)
  157. #define xennet_sysfs_delif(dev) do { } while (0)
  158. #endif
  159. static int xennet_can_sg(struct net_device *dev)
  160. {
  161. return dev->features & NETIF_F_SG;
  162. }
  163. static void rx_refill_timeout(unsigned long data)
  164. {
  165. struct net_device *dev = (struct net_device *)data;
  166. struct netfront_info *np = netdev_priv(dev);
  167. netif_rx_schedule(&np->napi);
  168. }
  169. static int netfront_tx_slot_available(struct netfront_info *np)
  170. {
  171. return ((np->tx.req_prod_pvt - np->tx.rsp_cons) <
  172. (TX_MAX_TARGET - MAX_SKB_FRAGS - 2));
  173. }
  174. static void xennet_maybe_wake_tx(struct net_device *dev)
  175. {
  176. struct netfront_info *np = netdev_priv(dev);
  177. if (unlikely(netif_queue_stopped(dev)) &&
  178. netfront_tx_slot_available(np) &&
  179. likely(netif_running(dev)))
  180. netif_wake_queue(dev);
  181. }
  182. static void xennet_alloc_rx_buffers(struct net_device *dev)
  183. {
  184. unsigned short id;
  185. struct netfront_info *np = netdev_priv(dev);
  186. struct sk_buff *skb;
  187. struct page *page;
  188. int i, batch_target, notify;
  189. RING_IDX req_prod = np->rx.req_prod_pvt;
  190. grant_ref_t ref;
  191. unsigned long pfn;
  192. void *vaddr;
  193. struct xen_netif_rx_request *req;
  194. if (unlikely(!netif_carrier_ok(dev)))
  195. return;
  196. /*
  197. * Allocate skbuffs greedily, even though we batch updates to the
  198. * receive ring. This creates a less bursty demand on the memory
  199. * allocator, so should reduce the chance of failed allocation requests
  200. * both for ourself and for other kernel subsystems.
  201. */
  202. batch_target = np->rx_target - (req_prod - np->rx.rsp_cons);
  203. for (i = skb_queue_len(&np->rx_batch); i < batch_target; i++) {
  204. skb = __netdev_alloc_skb(dev, RX_COPY_THRESHOLD + NET_IP_ALIGN,
  205. GFP_ATOMIC | __GFP_NOWARN);
  206. if (unlikely(!skb))
  207. goto no_skb;
  208. /* Align ip header to a 16 bytes boundary */
  209. skb_reserve(skb, NET_IP_ALIGN);
  210. page = alloc_page(GFP_ATOMIC | __GFP_NOWARN);
  211. if (!page) {
  212. kfree_skb(skb);
  213. no_skb:
  214. /* Any skbuffs queued for refill? Force them out. */
  215. if (i != 0)
  216. goto refill;
  217. /* Could not allocate any skbuffs. Try again later. */
  218. mod_timer(&np->rx_refill_timer,
  219. jiffies + (HZ/10));
  220. break;
  221. }
  222. skb_shinfo(skb)->frags[0].page = page;
  223. skb_shinfo(skb)->nr_frags = 1;
  224. __skb_queue_tail(&np->rx_batch, skb);
  225. }
  226. /* Is the batch large enough to be worthwhile? */
  227. if (i < (np->rx_target/2)) {
  228. if (req_prod > np->rx.sring->req_prod)
  229. goto push;
  230. return;
  231. }
  232. /* Adjust our fill target if we risked running out of buffers. */
  233. if (((req_prod - np->rx.sring->rsp_prod) < (np->rx_target / 4)) &&
  234. ((np->rx_target *= 2) > np->rx_max_target))
  235. np->rx_target = np->rx_max_target;
  236. refill:
  237. for (i = 0; ; i++) {
  238. skb = __skb_dequeue(&np->rx_batch);
  239. if (skb == NULL)
  240. break;
  241. skb->dev = dev;
  242. id = xennet_rxidx(req_prod + i);
  243. BUG_ON(np->rx_skbs[id]);
  244. np->rx_skbs[id] = skb;
  245. ref = gnttab_claim_grant_reference(&np->gref_rx_head);
  246. BUG_ON((signed short)ref < 0);
  247. np->grant_rx_ref[id] = ref;
  248. pfn = page_to_pfn(skb_shinfo(skb)->frags[0].page);
  249. vaddr = page_address(skb_shinfo(skb)->frags[0].page);
  250. req = RING_GET_REQUEST(&np->rx, req_prod + i);
  251. gnttab_grant_foreign_access_ref(ref,
  252. np->xbdev->otherend_id,
  253. pfn_to_mfn(pfn),
  254. 0);
  255. req->id = id;
  256. req->gref = ref;
  257. }
  258. wmb(); /* barrier so backend seens requests */
  259. /* Above is a suitable barrier to ensure backend will see requests. */
  260. np->rx.req_prod_pvt = req_prod + i;
  261. push:
  262. RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&np->rx, notify);
  263. if (notify)
  264. notify_remote_via_irq(np->netdev->irq);
  265. }
  266. static int xennet_open(struct net_device *dev)
  267. {
  268. struct netfront_info *np = netdev_priv(dev);
  269. napi_enable(&np->napi);
  270. spin_lock_bh(&np->rx_lock);
  271. if (netif_carrier_ok(dev)) {
  272. xennet_alloc_rx_buffers(dev);
  273. np->rx.sring->rsp_event = np->rx.rsp_cons + 1;
  274. if (RING_HAS_UNCONSUMED_RESPONSES(&np->rx))
  275. netif_rx_schedule(&np->napi);
  276. }
  277. spin_unlock_bh(&np->rx_lock);
  278. netif_start_queue(dev);
  279. return 0;
  280. }
  281. static void xennet_tx_buf_gc(struct net_device *dev)
  282. {
  283. RING_IDX cons, prod;
  284. unsigned short id;
  285. struct netfront_info *np = netdev_priv(dev);
  286. struct sk_buff *skb;
  287. BUG_ON(!netif_carrier_ok(dev));
  288. do {
  289. prod = np->tx.sring->rsp_prod;
  290. rmb(); /* Ensure we see responses up to 'rp'. */
  291. for (cons = np->tx.rsp_cons; cons != prod; cons++) {
  292. struct xen_netif_tx_response *txrsp;
  293. txrsp = RING_GET_RESPONSE(&np->tx, cons);
  294. if (txrsp->status == NETIF_RSP_NULL)
  295. continue;
  296. id = txrsp->id;
  297. skb = np->tx_skbs[id].skb;
  298. if (unlikely(gnttab_query_foreign_access(
  299. np->grant_tx_ref[id]) != 0)) {
  300. printk(KERN_ALERT "xennet_tx_buf_gc: warning "
  301. "-- grant still in use by backend "
  302. "domain.\n");
  303. BUG();
  304. }
  305. gnttab_end_foreign_access_ref(
  306. np->grant_tx_ref[id], GNTMAP_readonly);
  307. gnttab_release_grant_reference(
  308. &np->gref_tx_head, np->grant_tx_ref[id]);
  309. np->grant_tx_ref[id] = GRANT_INVALID_REF;
  310. add_id_to_freelist(&np->tx_skb_freelist, np->tx_skbs, id);
  311. dev_kfree_skb_irq(skb);
  312. }
  313. np->tx.rsp_cons = prod;
  314. /*
  315. * Set a new event, then check for race with update of tx_cons.
  316. * Note that it is essential to schedule a callback, no matter
  317. * how few buffers are pending. Even if there is space in the
  318. * transmit ring, higher layers may be blocked because too much
  319. * data is outstanding: in such cases notification from Xen is
  320. * likely to be the only kick that we'll get.
  321. */
  322. np->tx.sring->rsp_event =
  323. prod + ((np->tx.sring->req_prod - prod) >> 1) + 1;
  324. mb(); /* update shared area */
  325. } while ((cons == prod) && (prod != np->tx.sring->rsp_prod));
  326. xennet_maybe_wake_tx(dev);
  327. }
  328. static void xennet_make_frags(struct sk_buff *skb, struct net_device *dev,
  329. struct xen_netif_tx_request *tx)
  330. {
  331. struct netfront_info *np = netdev_priv(dev);
  332. char *data = skb->data;
  333. unsigned long mfn;
  334. RING_IDX prod = np->tx.req_prod_pvt;
  335. int frags = skb_shinfo(skb)->nr_frags;
  336. unsigned int offset = offset_in_page(data);
  337. unsigned int len = skb_headlen(skb);
  338. unsigned int id;
  339. grant_ref_t ref;
  340. int i;
  341. /* While the header overlaps a page boundary (including being
  342. larger than a page), split it it into page-sized chunks. */
  343. while (len > PAGE_SIZE - offset) {
  344. tx->size = PAGE_SIZE - offset;
  345. tx->flags |= NETTXF_more_data;
  346. len -= tx->size;
  347. data += tx->size;
  348. offset = 0;
  349. id = get_id_from_freelist(&np->tx_skb_freelist, np->tx_skbs);
  350. np->tx_skbs[id].skb = skb_get(skb);
  351. tx = RING_GET_REQUEST(&np->tx, prod++);
  352. tx->id = id;
  353. ref = gnttab_claim_grant_reference(&np->gref_tx_head);
  354. BUG_ON((signed short)ref < 0);
  355. mfn = virt_to_mfn(data);
  356. gnttab_grant_foreign_access_ref(ref, np->xbdev->otherend_id,
  357. mfn, GNTMAP_readonly);
  358. tx->gref = np->grant_tx_ref[id] = ref;
  359. tx->offset = offset;
  360. tx->size = len;
  361. tx->flags = 0;
  362. }
  363. /* Grant backend access to each skb fragment page. */
  364. for (i = 0; i < frags; i++) {
  365. skb_frag_t *frag = skb_shinfo(skb)->frags + i;
  366. tx->flags |= NETTXF_more_data;
  367. id = get_id_from_freelist(&np->tx_skb_freelist, np->tx_skbs);
  368. np->tx_skbs[id].skb = skb_get(skb);
  369. tx = RING_GET_REQUEST(&np->tx, prod++);
  370. tx->id = id;
  371. ref = gnttab_claim_grant_reference(&np->gref_tx_head);
  372. BUG_ON((signed short)ref < 0);
  373. mfn = pfn_to_mfn(page_to_pfn(frag->page));
  374. gnttab_grant_foreign_access_ref(ref, np->xbdev->otherend_id,
  375. mfn, GNTMAP_readonly);
  376. tx->gref = np->grant_tx_ref[id] = ref;
  377. tx->offset = frag->page_offset;
  378. tx->size = frag->size;
  379. tx->flags = 0;
  380. }
  381. np->tx.req_prod_pvt = prod;
  382. }
  383. static int xennet_start_xmit(struct sk_buff *skb, struct net_device *dev)
  384. {
  385. unsigned short id;
  386. struct netfront_info *np = netdev_priv(dev);
  387. struct xen_netif_tx_request *tx;
  388. struct xen_netif_extra_info *extra;
  389. char *data = skb->data;
  390. RING_IDX i;
  391. grant_ref_t ref;
  392. unsigned long mfn;
  393. int notify;
  394. int frags = skb_shinfo(skb)->nr_frags;
  395. unsigned int offset = offset_in_page(data);
  396. unsigned int len = skb_headlen(skb);
  397. frags += DIV_ROUND_UP(offset + len, PAGE_SIZE);
  398. if (unlikely(frags > MAX_SKB_FRAGS + 1)) {
  399. printk(KERN_ALERT "xennet: skb rides the rocket: %d frags\n",
  400. frags);
  401. dump_stack();
  402. goto drop;
  403. }
  404. spin_lock_irq(&np->tx_lock);
  405. if (unlikely(!netif_carrier_ok(dev) ||
  406. (frags > 1 && !xennet_can_sg(dev)) ||
  407. netif_needs_gso(dev, skb))) {
  408. spin_unlock_irq(&np->tx_lock);
  409. goto drop;
  410. }
  411. i = np->tx.req_prod_pvt;
  412. id = get_id_from_freelist(&np->tx_skb_freelist, np->tx_skbs);
  413. np->tx_skbs[id].skb = skb;
  414. tx = RING_GET_REQUEST(&np->tx, i);
  415. tx->id = id;
  416. ref = gnttab_claim_grant_reference(&np->gref_tx_head);
  417. BUG_ON((signed short)ref < 0);
  418. mfn = virt_to_mfn(data);
  419. gnttab_grant_foreign_access_ref(
  420. ref, np->xbdev->otherend_id, mfn, GNTMAP_readonly);
  421. tx->gref = np->grant_tx_ref[id] = ref;
  422. tx->offset = offset;
  423. tx->size = len;
  424. extra = NULL;
  425. tx->flags = 0;
  426. if (skb->ip_summed == CHECKSUM_PARTIAL)
  427. /* local packet? */
  428. tx->flags |= NETTXF_csum_blank | NETTXF_data_validated;
  429. else if (skb->ip_summed == CHECKSUM_UNNECESSARY)
  430. /* remote but checksummed. */
  431. tx->flags |= NETTXF_data_validated;
  432. if (skb_shinfo(skb)->gso_size) {
  433. struct xen_netif_extra_info *gso;
  434. gso = (struct xen_netif_extra_info *)
  435. RING_GET_REQUEST(&np->tx, ++i);
  436. if (extra)
  437. extra->flags |= XEN_NETIF_EXTRA_FLAG_MORE;
  438. else
  439. tx->flags |= NETTXF_extra_info;
  440. gso->u.gso.size = skb_shinfo(skb)->gso_size;
  441. gso->u.gso.type = XEN_NETIF_GSO_TYPE_TCPV4;
  442. gso->u.gso.pad = 0;
  443. gso->u.gso.features = 0;
  444. gso->type = XEN_NETIF_EXTRA_TYPE_GSO;
  445. gso->flags = 0;
  446. extra = gso;
  447. }
  448. np->tx.req_prod_pvt = i + 1;
  449. xennet_make_frags(skb, dev, tx);
  450. tx->size = skb->len;
  451. RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&np->tx, notify);
  452. if (notify)
  453. notify_remote_via_irq(np->netdev->irq);
  454. dev->stats.tx_bytes += skb->len;
  455. dev->stats.tx_packets++;
  456. /* Note: It is not safe to access skb after xennet_tx_buf_gc()! */
  457. xennet_tx_buf_gc(dev);
  458. if (!netfront_tx_slot_available(np))
  459. netif_stop_queue(dev);
  460. spin_unlock_irq(&np->tx_lock);
  461. return 0;
  462. drop:
  463. dev->stats.tx_dropped++;
  464. dev_kfree_skb(skb);
  465. return 0;
  466. }
  467. static int xennet_close(struct net_device *dev)
  468. {
  469. struct netfront_info *np = netdev_priv(dev);
  470. netif_stop_queue(np->netdev);
  471. napi_disable(&np->napi);
  472. return 0;
  473. }
  474. static void xennet_move_rx_slot(struct netfront_info *np, struct sk_buff *skb,
  475. grant_ref_t ref)
  476. {
  477. int new = xennet_rxidx(np->rx.req_prod_pvt);
  478. BUG_ON(np->rx_skbs[new]);
  479. np->rx_skbs[new] = skb;
  480. np->grant_rx_ref[new] = ref;
  481. RING_GET_REQUEST(&np->rx, np->rx.req_prod_pvt)->id = new;
  482. RING_GET_REQUEST(&np->rx, np->rx.req_prod_pvt)->gref = ref;
  483. np->rx.req_prod_pvt++;
  484. }
  485. static int xennet_get_extras(struct netfront_info *np,
  486. struct xen_netif_extra_info *extras,
  487. RING_IDX rp)
  488. {
  489. struct xen_netif_extra_info *extra;
  490. struct device *dev = &np->netdev->dev;
  491. RING_IDX cons = np->rx.rsp_cons;
  492. int err = 0;
  493. do {
  494. struct sk_buff *skb;
  495. grant_ref_t ref;
  496. if (unlikely(cons + 1 == rp)) {
  497. if (net_ratelimit())
  498. dev_warn(dev, "Missing extra info\n");
  499. err = -EBADR;
  500. break;
  501. }
  502. extra = (struct xen_netif_extra_info *)
  503. RING_GET_RESPONSE(&np->rx, ++cons);
  504. if (unlikely(!extra->type ||
  505. extra->type >= XEN_NETIF_EXTRA_TYPE_MAX)) {
  506. if (net_ratelimit())
  507. dev_warn(dev, "Invalid extra type: %d\n",
  508. extra->type);
  509. err = -EINVAL;
  510. } else {
  511. memcpy(&extras[extra->type - 1], extra,
  512. sizeof(*extra));
  513. }
  514. skb = xennet_get_rx_skb(np, cons);
  515. ref = xennet_get_rx_ref(np, cons);
  516. xennet_move_rx_slot(np, skb, ref);
  517. } while (extra->flags & XEN_NETIF_EXTRA_FLAG_MORE);
  518. np->rx.rsp_cons = cons;
  519. return err;
  520. }
  521. static int xennet_get_responses(struct netfront_info *np,
  522. struct netfront_rx_info *rinfo, RING_IDX rp,
  523. struct sk_buff_head *list)
  524. {
  525. struct xen_netif_rx_response *rx = &rinfo->rx;
  526. struct xen_netif_extra_info *extras = rinfo->extras;
  527. struct device *dev = &np->netdev->dev;
  528. RING_IDX cons = np->rx.rsp_cons;
  529. struct sk_buff *skb = xennet_get_rx_skb(np, cons);
  530. grant_ref_t ref = xennet_get_rx_ref(np, cons);
  531. int max = MAX_SKB_FRAGS + (rx->status <= RX_COPY_THRESHOLD);
  532. int frags = 1;
  533. int err = 0;
  534. unsigned long ret;
  535. if (rx->flags & NETRXF_extra_info) {
  536. err = xennet_get_extras(np, extras, rp);
  537. cons = np->rx.rsp_cons;
  538. }
  539. for (;;) {
  540. if (unlikely(rx->status < 0 ||
  541. rx->offset + rx->status > PAGE_SIZE)) {
  542. if (net_ratelimit())
  543. dev_warn(dev, "rx->offset: %x, size: %u\n",
  544. rx->offset, rx->status);
  545. xennet_move_rx_slot(np, skb, ref);
  546. err = -EINVAL;
  547. goto next;
  548. }
  549. /*
  550. * This definitely indicates a bug, either in this driver or in
  551. * the backend driver. In future this should flag the bad
  552. * situation to the system controller to reboot the backed.
  553. */
  554. if (ref == GRANT_INVALID_REF) {
  555. if (net_ratelimit())
  556. dev_warn(dev, "Bad rx response id %d.\n",
  557. rx->id);
  558. err = -EINVAL;
  559. goto next;
  560. }
  561. ret = gnttab_end_foreign_access_ref(ref, 0);
  562. BUG_ON(!ret);
  563. gnttab_release_grant_reference(&np->gref_rx_head, ref);
  564. __skb_queue_tail(list, skb);
  565. next:
  566. if (!(rx->flags & NETRXF_more_data))
  567. break;
  568. if (cons + frags == rp) {
  569. if (net_ratelimit())
  570. dev_warn(dev, "Need more frags\n");
  571. err = -ENOENT;
  572. break;
  573. }
  574. rx = RING_GET_RESPONSE(&np->rx, cons + frags);
  575. skb = xennet_get_rx_skb(np, cons + frags);
  576. ref = xennet_get_rx_ref(np, cons + frags);
  577. frags++;
  578. }
  579. if (unlikely(frags > max)) {
  580. if (net_ratelimit())
  581. dev_warn(dev, "Too many frags\n");
  582. err = -E2BIG;
  583. }
  584. if (unlikely(err))
  585. np->rx.rsp_cons = cons + frags;
  586. return err;
  587. }
  588. static int xennet_set_skb_gso(struct sk_buff *skb,
  589. struct xen_netif_extra_info *gso)
  590. {
  591. if (!gso->u.gso.size) {
  592. if (net_ratelimit())
  593. printk(KERN_WARNING "GSO size must not be zero.\n");
  594. return -EINVAL;
  595. }
  596. /* Currently only TCPv4 S.O. is supported. */
  597. if (gso->u.gso.type != XEN_NETIF_GSO_TYPE_TCPV4) {
  598. if (net_ratelimit())
  599. printk(KERN_WARNING "Bad GSO type %d.\n", gso->u.gso.type);
  600. return -EINVAL;
  601. }
  602. skb_shinfo(skb)->gso_size = gso->u.gso.size;
  603. skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
  604. /* Header must be checked, and gso_segs computed. */
  605. skb_shinfo(skb)->gso_type |= SKB_GSO_DODGY;
  606. skb_shinfo(skb)->gso_segs = 0;
  607. return 0;
  608. }
  609. static RING_IDX xennet_fill_frags(struct netfront_info *np,
  610. struct sk_buff *skb,
  611. struct sk_buff_head *list)
  612. {
  613. struct skb_shared_info *shinfo = skb_shinfo(skb);
  614. int nr_frags = shinfo->nr_frags;
  615. RING_IDX cons = np->rx.rsp_cons;
  616. skb_frag_t *frag = shinfo->frags + nr_frags;
  617. struct sk_buff *nskb;
  618. while ((nskb = __skb_dequeue(list))) {
  619. struct xen_netif_rx_response *rx =
  620. RING_GET_RESPONSE(&np->rx, ++cons);
  621. frag->page = skb_shinfo(nskb)->frags[0].page;
  622. frag->page_offset = rx->offset;
  623. frag->size = rx->status;
  624. skb->data_len += rx->status;
  625. skb_shinfo(nskb)->nr_frags = 0;
  626. kfree_skb(nskb);
  627. frag++;
  628. nr_frags++;
  629. }
  630. shinfo->nr_frags = nr_frags;
  631. return cons;
  632. }
  633. static int skb_checksum_setup(struct sk_buff *skb)
  634. {
  635. struct iphdr *iph;
  636. unsigned char *th;
  637. int err = -EPROTO;
  638. if (skb->protocol != htons(ETH_P_IP))
  639. goto out;
  640. iph = (void *)skb->data;
  641. th = skb->data + 4 * iph->ihl;
  642. if (th >= skb_tail_pointer(skb))
  643. goto out;
  644. skb->csum_start = th - skb->head;
  645. switch (iph->protocol) {
  646. case IPPROTO_TCP:
  647. skb->csum_offset = offsetof(struct tcphdr, check);
  648. break;
  649. case IPPROTO_UDP:
  650. skb->csum_offset = offsetof(struct udphdr, check);
  651. break;
  652. default:
  653. if (net_ratelimit())
  654. printk(KERN_ERR "Attempting to checksum a non-"
  655. "TCP/UDP packet, dropping a protocol"
  656. " %d packet", iph->protocol);
  657. goto out;
  658. }
  659. if ((th + skb->csum_offset + 2) > skb_tail_pointer(skb))
  660. goto out;
  661. err = 0;
  662. out:
  663. return err;
  664. }
  665. static int handle_incoming_queue(struct net_device *dev,
  666. struct sk_buff_head *rxq)
  667. {
  668. int packets_dropped = 0;
  669. struct sk_buff *skb;
  670. while ((skb = __skb_dequeue(rxq)) != NULL) {
  671. struct page *page = NETFRONT_SKB_CB(skb)->page;
  672. void *vaddr = page_address(page);
  673. unsigned offset = NETFRONT_SKB_CB(skb)->offset;
  674. memcpy(skb->data, vaddr + offset,
  675. skb_headlen(skb));
  676. if (page != skb_shinfo(skb)->frags[0].page)
  677. __free_page(page);
  678. /* Ethernet work: Delayed to here as it peeks the header. */
  679. skb->protocol = eth_type_trans(skb, dev);
  680. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  681. if (skb_checksum_setup(skb)) {
  682. kfree_skb(skb);
  683. packets_dropped++;
  684. dev->stats.rx_errors++;
  685. continue;
  686. }
  687. }
  688. dev->stats.rx_packets++;
  689. dev->stats.rx_bytes += skb->len;
  690. /* Pass it up. */
  691. netif_receive_skb(skb);
  692. }
  693. return packets_dropped;
  694. }
  695. static int xennet_poll(struct napi_struct *napi, int budget)
  696. {
  697. struct netfront_info *np = container_of(napi, struct netfront_info, napi);
  698. struct net_device *dev = np->netdev;
  699. struct sk_buff *skb;
  700. struct netfront_rx_info rinfo;
  701. struct xen_netif_rx_response *rx = &rinfo.rx;
  702. struct xen_netif_extra_info *extras = rinfo.extras;
  703. RING_IDX i, rp;
  704. int work_done;
  705. struct sk_buff_head rxq;
  706. struct sk_buff_head errq;
  707. struct sk_buff_head tmpq;
  708. unsigned long flags;
  709. unsigned int len;
  710. int err;
  711. spin_lock(&np->rx_lock);
  712. skb_queue_head_init(&rxq);
  713. skb_queue_head_init(&errq);
  714. skb_queue_head_init(&tmpq);
  715. rp = np->rx.sring->rsp_prod;
  716. rmb(); /* Ensure we see queued responses up to 'rp'. */
  717. i = np->rx.rsp_cons;
  718. work_done = 0;
  719. while ((i != rp) && (work_done < budget)) {
  720. memcpy(rx, RING_GET_RESPONSE(&np->rx, i), sizeof(*rx));
  721. memset(extras, 0, sizeof(rinfo.extras));
  722. err = xennet_get_responses(np, &rinfo, rp, &tmpq);
  723. if (unlikely(err)) {
  724. err:
  725. while ((skb = __skb_dequeue(&tmpq)))
  726. __skb_queue_tail(&errq, skb);
  727. dev->stats.rx_errors++;
  728. i = np->rx.rsp_cons;
  729. continue;
  730. }
  731. skb = __skb_dequeue(&tmpq);
  732. if (extras[XEN_NETIF_EXTRA_TYPE_GSO - 1].type) {
  733. struct xen_netif_extra_info *gso;
  734. gso = &extras[XEN_NETIF_EXTRA_TYPE_GSO - 1];
  735. if (unlikely(xennet_set_skb_gso(skb, gso))) {
  736. __skb_queue_head(&tmpq, skb);
  737. np->rx.rsp_cons += skb_queue_len(&tmpq);
  738. goto err;
  739. }
  740. }
  741. NETFRONT_SKB_CB(skb)->page = skb_shinfo(skb)->frags[0].page;
  742. NETFRONT_SKB_CB(skb)->offset = rx->offset;
  743. len = rx->status;
  744. if (len > RX_COPY_THRESHOLD)
  745. len = RX_COPY_THRESHOLD;
  746. skb_put(skb, len);
  747. if (rx->status > len) {
  748. skb_shinfo(skb)->frags[0].page_offset =
  749. rx->offset + len;
  750. skb_shinfo(skb)->frags[0].size = rx->status - len;
  751. skb->data_len = rx->status - len;
  752. } else {
  753. skb_shinfo(skb)->frags[0].page = NULL;
  754. skb_shinfo(skb)->nr_frags = 0;
  755. }
  756. i = xennet_fill_frags(np, skb, &tmpq);
  757. /*
  758. * Truesize approximates the size of true data plus
  759. * any supervisor overheads. Adding hypervisor
  760. * overheads has been shown to significantly reduce
  761. * achievable bandwidth with the default receive
  762. * buffer size. It is therefore not wise to account
  763. * for it here.
  764. *
  765. * After alloc_skb(RX_COPY_THRESHOLD), truesize is set
  766. * to RX_COPY_THRESHOLD + the supervisor
  767. * overheads. Here, we add the size of the data pulled
  768. * in xennet_fill_frags().
  769. *
  770. * We also adjust for any unused space in the main
  771. * data area by subtracting (RX_COPY_THRESHOLD -
  772. * len). This is especially important with drivers
  773. * which split incoming packets into header and data,
  774. * using only 66 bytes of the main data area (see the
  775. * e1000 driver for example.) On such systems,
  776. * without this last adjustement, our achievable
  777. * receive throughout using the standard receive
  778. * buffer size was cut by 25%(!!!).
  779. */
  780. skb->truesize += skb->data_len - (RX_COPY_THRESHOLD - len);
  781. skb->len += skb->data_len;
  782. if (rx->flags & NETRXF_csum_blank)
  783. skb->ip_summed = CHECKSUM_PARTIAL;
  784. else if (rx->flags & NETRXF_data_validated)
  785. skb->ip_summed = CHECKSUM_UNNECESSARY;
  786. __skb_queue_tail(&rxq, skb);
  787. np->rx.rsp_cons = ++i;
  788. work_done++;
  789. }
  790. __skb_queue_purge(&errq);
  791. work_done -= handle_incoming_queue(dev, &rxq);
  792. /* If we get a callback with very few responses, reduce fill target. */
  793. /* NB. Note exponential increase, linear decrease. */
  794. if (((np->rx.req_prod_pvt - np->rx.sring->rsp_prod) >
  795. ((3*np->rx_target) / 4)) &&
  796. (--np->rx_target < np->rx_min_target))
  797. np->rx_target = np->rx_min_target;
  798. xennet_alloc_rx_buffers(dev);
  799. if (work_done < budget) {
  800. int more_to_do = 0;
  801. local_irq_save(flags);
  802. RING_FINAL_CHECK_FOR_RESPONSES(&np->rx, more_to_do);
  803. if (!more_to_do)
  804. __netif_rx_complete(napi);
  805. local_irq_restore(flags);
  806. }
  807. spin_unlock(&np->rx_lock);
  808. return work_done;
  809. }
  810. static int xennet_change_mtu(struct net_device *dev, int mtu)
  811. {
  812. int max = xennet_can_sg(dev) ? 65535 - ETH_HLEN : ETH_DATA_LEN;
  813. if (mtu > max)
  814. return -EINVAL;
  815. dev->mtu = mtu;
  816. return 0;
  817. }
  818. static void xennet_release_tx_bufs(struct netfront_info *np)
  819. {
  820. struct sk_buff *skb;
  821. int i;
  822. for (i = 0; i < NET_TX_RING_SIZE; i++) {
  823. /* Skip over entries which are actually freelist references */
  824. if (skb_entry_is_link(&np->tx_skbs[i]))
  825. continue;
  826. skb = np->tx_skbs[i].skb;
  827. gnttab_end_foreign_access_ref(np->grant_tx_ref[i],
  828. GNTMAP_readonly);
  829. gnttab_release_grant_reference(&np->gref_tx_head,
  830. np->grant_tx_ref[i]);
  831. np->grant_tx_ref[i] = GRANT_INVALID_REF;
  832. add_id_to_freelist(&np->tx_skb_freelist, np->tx_skbs, i);
  833. dev_kfree_skb_irq(skb);
  834. }
  835. }
  836. static void xennet_release_rx_bufs(struct netfront_info *np)
  837. {
  838. struct mmu_update *mmu = np->rx_mmu;
  839. struct multicall_entry *mcl = np->rx_mcl;
  840. struct sk_buff_head free_list;
  841. struct sk_buff *skb;
  842. unsigned long mfn;
  843. int xfer = 0, noxfer = 0, unused = 0;
  844. int id, ref;
  845. dev_warn(&np->netdev->dev, "%s: fix me for copying receiver.\n",
  846. __func__);
  847. return;
  848. skb_queue_head_init(&free_list);
  849. spin_lock_bh(&np->rx_lock);
  850. for (id = 0; id < NET_RX_RING_SIZE; id++) {
  851. ref = np->grant_rx_ref[id];
  852. if (ref == GRANT_INVALID_REF) {
  853. unused++;
  854. continue;
  855. }
  856. skb = np->rx_skbs[id];
  857. mfn = gnttab_end_foreign_transfer_ref(ref);
  858. gnttab_release_grant_reference(&np->gref_rx_head, ref);
  859. np->grant_rx_ref[id] = GRANT_INVALID_REF;
  860. if (0 == mfn) {
  861. skb_shinfo(skb)->nr_frags = 0;
  862. dev_kfree_skb(skb);
  863. noxfer++;
  864. continue;
  865. }
  866. if (!xen_feature(XENFEAT_auto_translated_physmap)) {
  867. /* Remap the page. */
  868. struct page *page = skb_shinfo(skb)->frags[0].page;
  869. unsigned long pfn = page_to_pfn(page);
  870. void *vaddr = page_address(page);
  871. MULTI_update_va_mapping(mcl, (unsigned long)vaddr,
  872. mfn_pte(mfn, PAGE_KERNEL),
  873. 0);
  874. mcl++;
  875. mmu->ptr = ((u64)mfn << PAGE_SHIFT)
  876. | MMU_MACHPHYS_UPDATE;
  877. mmu->val = pfn;
  878. mmu++;
  879. set_phys_to_machine(pfn, mfn);
  880. }
  881. __skb_queue_tail(&free_list, skb);
  882. xfer++;
  883. }
  884. dev_info(&np->netdev->dev, "%s: %d xfer, %d noxfer, %d unused\n",
  885. __func__, xfer, noxfer, unused);
  886. if (xfer) {
  887. if (!xen_feature(XENFEAT_auto_translated_physmap)) {
  888. /* Do all the remapping work and M2P updates. */
  889. MULTI_mmu_update(mcl, np->rx_mmu, mmu - np->rx_mmu,
  890. NULL, DOMID_SELF);
  891. mcl++;
  892. HYPERVISOR_multicall(np->rx_mcl, mcl - np->rx_mcl);
  893. }
  894. }
  895. __skb_queue_purge(&free_list);
  896. spin_unlock_bh(&np->rx_lock);
  897. }
  898. static void xennet_uninit(struct net_device *dev)
  899. {
  900. struct netfront_info *np = netdev_priv(dev);
  901. xennet_release_tx_bufs(np);
  902. xennet_release_rx_bufs(np);
  903. gnttab_free_grant_references(np->gref_tx_head);
  904. gnttab_free_grant_references(np->gref_rx_head);
  905. }
  906. static struct net_device * __devinit xennet_create_dev(struct xenbus_device *dev)
  907. {
  908. int i, err;
  909. struct net_device *netdev;
  910. struct netfront_info *np;
  911. netdev = alloc_etherdev(sizeof(struct netfront_info));
  912. if (!netdev) {
  913. printk(KERN_WARNING "%s> alloc_etherdev failed.\n",
  914. __func__);
  915. return ERR_PTR(-ENOMEM);
  916. }
  917. np = netdev_priv(netdev);
  918. np->xbdev = dev;
  919. spin_lock_init(&np->tx_lock);
  920. spin_lock_init(&np->rx_lock);
  921. skb_queue_head_init(&np->rx_batch);
  922. np->rx_target = RX_DFL_MIN_TARGET;
  923. np->rx_min_target = RX_DFL_MIN_TARGET;
  924. np->rx_max_target = RX_MAX_TARGET;
  925. init_timer(&np->rx_refill_timer);
  926. np->rx_refill_timer.data = (unsigned long)netdev;
  927. np->rx_refill_timer.function = rx_refill_timeout;
  928. /* Initialise tx_skbs as a free chain containing every entry. */
  929. np->tx_skb_freelist = 0;
  930. for (i = 0; i < NET_TX_RING_SIZE; i++) {
  931. skb_entry_set_link(&np->tx_skbs[i], i+1);
  932. np->grant_tx_ref[i] = GRANT_INVALID_REF;
  933. }
  934. /* Clear out rx_skbs */
  935. for (i = 0; i < NET_RX_RING_SIZE; i++) {
  936. np->rx_skbs[i] = NULL;
  937. np->grant_rx_ref[i] = GRANT_INVALID_REF;
  938. }
  939. /* A grant for every tx ring slot */
  940. if (gnttab_alloc_grant_references(TX_MAX_TARGET,
  941. &np->gref_tx_head) < 0) {
  942. printk(KERN_ALERT "#### netfront can't alloc tx grant refs\n");
  943. err = -ENOMEM;
  944. goto exit;
  945. }
  946. /* A grant for every rx ring slot */
  947. if (gnttab_alloc_grant_references(RX_MAX_TARGET,
  948. &np->gref_rx_head) < 0) {
  949. printk(KERN_ALERT "#### netfront can't alloc rx grant refs\n");
  950. err = -ENOMEM;
  951. goto exit_free_tx;
  952. }
  953. netdev->open = xennet_open;
  954. netdev->hard_start_xmit = xennet_start_xmit;
  955. netdev->stop = xennet_close;
  956. netif_napi_add(netdev, &np->napi, xennet_poll, 64);
  957. netdev->uninit = xennet_uninit;
  958. netdev->change_mtu = xennet_change_mtu;
  959. netdev->features = NETIF_F_IP_CSUM;
  960. SET_ETHTOOL_OPS(netdev, &xennet_ethtool_ops);
  961. SET_NETDEV_DEV(netdev, &dev->dev);
  962. np->netdev = netdev;
  963. netif_carrier_off(netdev);
  964. return netdev;
  965. exit_free_tx:
  966. gnttab_free_grant_references(np->gref_tx_head);
  967. exit:
  968. free_netdev(netdev);
  969. return ERR_PTR(err);
  970. }
  971. /**
  972. * Entry point to this code when a new device is created. Allocate the basic
  973. * structures and the ring buffers for communication with the backend, and
  974. * inform the backend of the appropriate details for those.
  975. */
  976. static int __devinit netfront_probe(struct xenbus_device *dev,
  977. const struct xenbus_device_id *id)
  978. {
  979. int err;
  980. struct net_device *netdev;
  981. struct netfront_info *info;
  982. netdev = xennet_create_dev(dev);
  983. if (IS_ERR(netdev)) {
  984. err = PTR_ERR(netdev);
  985. xenbus_dev_fatal(dev, err, "creating netdev");
  986. return err;
  987. }
  988. info = netdev_priv(netdev);
  989. dev->dev.driver_data = info;
  990. err = register_netdev(info->netdev);
  991. if (err) {
  992. printk(KERN_WARNING "%s: register_netdev err=%d\n",
  993. __func__, err);
  994. goto fail;
  995. }
  996. err = xennet_sysfs_addif(info->netdev);
  997. if (err) {
  998. unregister_netdev(info->netdev);
  999. printk(KERN_WARNING "%s: add sysfs failed err=%d\n",
  1000. __func__, err);
  1001. goto fail;
  1002. }
  1003. return 0;
  1004. fail:
  1005. free_netdev(netdev);
  1006. dev->dev.driver_data = NULL;
  1007. return err;
  1008. }
  1009. static void xennet_end_access(int ref, void *page)
  1010. {
  1011. /* This frees the page as a side-effect */
  1012. if (ref != GRANT_INVALID_REF)
  1013. gnttab_end_foreign_access(ref, 0, (unsigned long)page);
  1014. }
  1015. static void xennet_disconnect_backend(struct netfront_info *info)
  1016. {
  1017. /* Stop old i/f to prevent errors whilst we rebuild the state. */
  1018. spin_lock_bh(&info->rx_lock);
  1019. spin_lock_irq(&info->tx_lock);
  1020. netif_carrier_off(info->netdev);
  1021. spin_unlock_irq(&info->tx_lock);
  1022. spin_unlock_bh(&info->rx_lock);
  1023. if (info->netdev->irq)
  1024. unbind_from_irqhandler(info->netdev->irq, info->netdev);
  1025. info->evtchn = info->netdev->irq = 0;
  1026. /* End access and free the pages */
  1027. xennet_end_access(info->tx_ring_ref, info->tx.sring);
  1028. xennet_end_access(info->rx_ring_ref, info->rx.sring);
  1029. info->tx_ring_ref = GRANT_INVALID_REF;
  1030. info->rx_ring_ref = GRANT_INVALID_REF;
  1031. info->tx.sring = NULL;
  1032. info->rx.sring = NULL;
  1033. }
  1034. /**
  1035. * We are reconnecting to the backend, due to a suspend/resume, or a backend
  1036. * driver restart. We tear down our netif structure and recreate it, but
  1037. * leave the device-layer structures intact so that this is transparent to the
  1038. * rest of the kernel.
  1039. */
  1040. static int netfront_resume(struct xenbus_device *dev)
  1041. {
  1042. struct netfront_info *info = dev->dev.driver_data;
  1043. dev_dbg(&dev->dev, "%s\n", dev->nodename);
  1044. xennet_disconnect_backend(info);
  1045. return 0;
  1046. }
  1047. static int xen_net_read_mac(struct xenbus_device *dev, u8 mac[])
  1048. {
  1049. char *s, *e, *macstr;
  1050. int i;
  1051. macstr = s = xenbus_read(XBT_NIL, dev->nodename, "mac", NULL);
  1052. if (IS_ERR(macstr))
  1053. return PTR_ERR(macstr);
  1054. for (i = 0; i < ETH_ALEN; i++) {
  1055. mac[i] = simple_strtoul(s, &e, 16);
  1056. if ((s == e) || (*e != ((i == ETH_ALEN-1) ? '\0' : ':'))) {
  1057. kfree(macstr);
  1058. return -ENOENT;
  1059. }
  1060. s = e+1;
  1061. }
  1062. kfree(macstr);
  1063. return 0;
  1064. }
  1065. static irqreturn_t xennet_interrupt(int irq, void *dev_id)
  1066. {
  1067. struct net_device *dev = dev_id;
  1068. struct netfront_info *np = netdev_priv(dev);
  1069. unsigned long flags;
  1070. spin_lock_irqsave(&np->tx_lock, flags);
  1071. if (likely(netif_carrier_ok(dev))) {
  1072. xennet_tx_buf_gc(dev);
  1073. /* Under tx_lock: protects access to rx shared-ring indexes. */
  1074. if (RING_HAS_UNCONSUMED_RESPONSES(&np->rx))
  1075. netif_rx_schedule(&np->napi);
  1076. }
  1077. spin_unlock_irqrestore(&np->tx_lock, flags);
  1078. return IRQ_HANDLED;
  1079. }
  1080. static int setup_netfront(struct xenbus_device *dev, struct netfront_info *info)
  1081. {
  1082. struct xen_netif_tx_sring *txs;
  1083. struct xen_netif_rx_sring *rxs;
  1084. int err;
  1085. struct net_device *netdev = info->netdev;
  1086. info->tx_ring_ref = GRANT_INVALID_REF;
  1087. info->rx_ring_ref = GRANT_INVALID_REF;
  1088. info->rx.sring = NULL;
  1089. info->tx.sring = NULL;
  1090. netdev->irq = 0;
  1091. err = xen_net_read_mac(dev, netdev->dev_addr);
  1092. if (err) {
  1093. xenbus_dev_fatal(dev, err, "parsing %s/mac", dev->nodename);
  1094. goto fail;
  1095. }
  1096. txs = (struct xen_netif_tx_sring *)get_zeroed_page(GFP_NOIO | __GFP_HIGH);
  1097. if (!txs) {
  1098. err = -ENOMEM;
  1099. xenbus_dev_fatal(dev, err, "allocating tx ring page");
  1100. goto fail;
  1101. }
  1102. SHARED_RING_INIT(txs);
  1103. FRONT_RING_INIT(&info->tx, txs, PAGE_SIZE);
  1104. err = xenbus_grant_ring(dev, virt_to_mfn(txs));
  1105. if (err < 0) {
  1106. free_page((unsigned long)txs);
  1107. goto fail;
  1108. }
  1109. info->tx_ring_ref = err;
  1110. rxs = (struct xen_netif_rx_sring *)get_zeroed_page(GFP_NOIO | __GFP_HIGH);
  1111. if (!rxs) {
  1112. err = -ENOMEM;
  1113. xenbus_dev_fatal(dev, err, "allocating rx ring page");
  1114. goto fail;
  1115. }
  1116. SHARED_RING_INIT(rxs);
  1117. FRONT_RING_INIT(&info->rx, rxs, PAGE_SIZE);
  1118. err = xenbus_grant_ring(dev, virt_to_mfn(rxs));
  1119. if (err < 0) {
  1120. free_page((unsigned long)rxs);
  1121. goto fail;
  1122. }
  1123. info->rx_ring_ref = err;
  1124. err = xenbus_alloc_evtchn(dev, &info->evtchn);
  1125. if (err)
  1126. goto fail;
  1127. err = bind_evtchn_to_irqhandler(info->evtchn, xennet_interrupt,
  1128. IRQF_SAMPLE_RANDOM, netdev->name,
  1129. netdev);
  1130. if (err < 0)
  1131. goto fail;
  1132. netdev->irq = err;
  1133. return 0;
  1134. fail:
  1135. return err;
  1136. }
  1137. /* Common code used when first setting up, and when resuming. */
  1138. static int talk_to_backend(struct xenbus_device *dev,
  1139. struct netfront_info *info)
  1140. {
  1141. const char *message;
  1142. struct xenbus_transaction xbt;
  1143. int err;
  1144. /* Create shared ring, alloc event channel. */
  1145. err = setup_netfront(dev, info);
  1146. if (err)
  1147. goto out;
  1148. again:
  1149. err = xenbus_transaction_start(&xbt);
  1150. if (err) {
  1151. xenbus_dev_fatal(dev, err, "starting transaction");
  1152. goto destroy_ring;
  1153. }
  1154. err = xenbus_printf(xbt, dev->nodename, "tx-ring-ref", "%u",
  1155. info->tx_ring_ref);
  1156. if (err) {
  1157. message = "writing tx ring-ref";
  1158. goto abort_transaction;
  1159. }
  1160. err = xenbus_printf(xbt, dev->nodename, "rx-ring-ref", "%u",
  1161. info->rx_ring_ref);
  1162. if (err) {
  1163. message = "writing rx ring-ref";
  1164. goto abort_transaction;
  1165. }
  1166. err = xenbus_printf(xbt, dev->nodename,
  1167. "event-channel", "%u", info->evtchn);
  1168. if (err) {
  1169. message = "writing event-channel";
  1170. goto abort_transaction;
  1171. }
  1172. err = xenbus_printf(xbt, dev->nodename, "request-rx-copy", "%u",
  1173. 1);
  1174. if (err) {
  1175. message = "writing request-rx-copy";
  1176. goto abort_transaction;
  1177. }
  1178. err = xenbus_printf(xbt, dev->nodename, "feature-rx-notify", "%d", 1);
  1179. if (err) {
  1180. message = "writing feature-rx-notify";
  1181. goto abort_transaction;
  1182. }
  1183. err = xenbus_printf(xbt, dev->nodename, "feature-sg", "%d", 1);
  1184. if (err) {
  1185. message = "writing feature-sg";
  1186. goto abort_transaction;
  1187. }
  1188. err = xenbus_printf(xbt, dev->nodename, "feature-gso-tcpv4", "%d", 1);
  1189. if (err) {
  1190. message = "writing feature-gso-tcpv4";
  1191. goto abort_transaction;
  1192. }
  1193. err = xenbus_transaction_end(xbt, 0);
  1194. if (err) {
  1195. if (err == -EAGAIN)
  1196. goto again;
  1197. xenbus_dev_fatal(dev, err, "completing transaction");
  1198. goto destroy_ring;
  1199. }
  1200. return 0;
  1201. abort_transaction:
  1202. xenbus_transaction_end(xbt, 1);
  1203. xenbus_dev_fatal(dev, err, "%s", message);
  1204. destroy_ring:
  1205. xennet_disconnect_backend(info);
  1206. out:
  1207. return err;
  1208. }
  1209. static int xennet_set_sg(struct net_device *dev, u32 data)
  1210. {
  1211. if (data) {
  1212. struct netfront_info *np = netdev_priv(dev);
  1213. int val;
  1214. if (xenbus_scanf(XBT_NIL, np->xbdev->otherend, "feature-sg",
  1215. "%d", &val) < 0)
  1216. val = 0;
  1217. if (!val)
  1218. return -ENOSYS;
  1219. } else if (dev->mtu > ETH_DATA_LEN)
  1220. dev->mtu = ETH_DATA_LEN;
  1221. return ethtool_op_set_sg(dev, data);
  1222. }
  1223. static int xennet_set_tso(struct net_device *dev, u32 data)
  1224. {
  1225. if (data) {
  1226. struct netfront_info *np = netdev_priv(dev);
  1227. int val;
  1228. if (xenbus_scanf(XBT_NIL, np->xbdev->otherend,
  1229. "feature-gso-tcpv4", "%d", &val) < 0)
  1230. val = 0;
  1231. if (!val)
  1232. return -ENOSYS;
  1233. }
  1234. return ethtool_op_set_tso(dev, data);
  1235. }
  1236. static void xennet_set_features(struct net_device *dev)
  1237. {
  1238. /* Turn off all GSO bits except ROBUST. */
  1239. dev->features &= (1 << NETIF_F_GSO_SHIFT) - 1;
  1240. dev->features |= NETIF_F_GSO_ROBUST;
  1241. xennet_set_sg(dev, 0);
  1242. /* We need checksum offload to enable scatter/gather and TSO. */
  1243. if (!(dev->features & NETIF_F_IP_CSUM))
  1244. return;
  1245. if (!xennet_set_sg(dev, 1))
  1246. xennet_set_tso(dev, 1);
  1247. }
  1248. static int xennet_connect(struct net_device *dev)
  1249. {
  1250. struct netfront_info *np = netdev_priv(dev);
  1251. int i, requeue_idx, err;
  1252. struct sk_buff *skb;
  1253. grant_ref_t ref;
  1254. struct xen_netif_rx_request *req;
  1255. unsigned int feature_rx_copy;
  1256. err = xenbus_scanf(XBT_NIL, np->xbdev->otherend,
  1257. "feature-rx-copy", "%u", &feature_rx_copy);
  1258. if (err != 1)
  1259. feature_rx_copy = 0;
  1260. if (!feature_rx_copy) {
  1261. dev_info(&dev->dev,
  1262. "backend does not support copying receive path\n");
  1263. return -ENODEV;
  1264. }
  1265. err = talk_to_backend(np->xbdev, np);
  1266. if (err)
  1267. return err;
  1268. xennet_set_features(dev);
  1269. spin_lock_bh(&np->rx_lock);
  1270. spin_lock_irq(&np->tx_lock);
  1271. /* Step 1: Discard all pending TX packet fragments. */
  1272. xennet_release_tx_bufs(np);
  1273. /* Step 2: Rebuild the RX buffer freelist and the RX ring itself. */
  1274. for (requeue_idx = 0, i = 0; i < NET_RX_RING_SIZE; i++) {
  1275. if (!np->rx_skbs[i])
  1276. continue;
  1277. skb = np->rx_skbs[requeue_idx] = xennet_get_rx_skb(np, i);
  1278. ref = np->grant_rx_ref[requeue_idx] = xennet_get_rx_ref(np, i);
  1279. req = RING_GET_REQUEST(&np->rx, requeue_idx);
  1280. gnttab_grant_foreign_access_ref(
  1281. ref, np->xbdev->otherend_id,
  1282. pfn_to_mfn(page_to_pfn(skb_shinfo(skb)->
  1283. frags->page)),
  1284. 0);
  1285. req->gref = ref;
  1286. req->id = requeue_idx;
  1287. requeue_idx++;
  1288. }
  1289. np->rx.req_prod_pvt = requeue_idx;
  1290. /*
  1291. * Step 3: All public and private state should now be sane. Get
  1292. * ready to start sending and receiving packets and give the driver
  1293. * domain a kick because we've probably just requeued some
  1294. * packets.
  1295. */
  1296. netif_carrier_on(np->netdev);
  1297. notify_remote_via_irq(np->netdev->irq);
  1298. xennet_tx_buf_gc(dev);
  1299. xennet_alloc_rx_buffers(dev);
  1300. spin_unlock_irq(&np->tx_lock);
  1301. spin_unlock_bh(&np->rx_lock);
  1302. return 0;
  1303. }
  1304. /**
  1305. * Callback received when the backend's state changes.
  1306. */
  1307. static void backend_changed(struct xenbus_device *dev,
  1308. enum xenbus_state backend_state)
  1309. {
  1310. struct netfront_info *np = dev->dev.driver_data;
  1311. struct net_device *netdev = np->netdev;
  1312. dev_dbg(&dev->dev, "%s\n", xenbus_strstate(backend_state));
  1313. switch (backend_state) {
  1314. case XenbusStateInitialising:
  1315. case XenbusStateInitialised:
  1316. case XenbusStateConnected:
  1317. case XenbusStateUnknown:
  1318. case XenbusStateClosed:
  1319. break;
  1320. case XenbusStateInitWait:
  1321. if (dev->state != XenbusStateInitialising)
  1322. break;
  1323. if (xennet_connect(netdev) != 0)
  1324. break;
  1325. xenbus_switch_state(dev, XenbusStateConnected);
  1326. break;
  1327. case XenbusStateClosing:
  1328. xenbus_frontend_closed(dev);
  1329. break;
  1330. }
  1331. }
  1332. static struct ethtool_ops xennet_ethtool_ops =
  1333. {
  1334. .set_tx_csum = ethtool_op_set_tx_csum,
  1335. .set_sg = xennet_set_sg,
  1336. .set_tso = xennet_set_tso,
  1337. .get_link = ethtool_op_get_link,
  1338. };
  1339. #ifdef CONFIG_SYSFS
  1340. static ssize_t show_rxbuf_min(struct device *dev,
  1341. struct device_attribute *attr, char *buf)
  1342. {
  1343. struct net_device *netdev = to_net_dev(dev);
  1344. struct netfront_info *info = netdev_priv(netdev);
  1345. return sprintf(buf, "%u\n", info->rx_min_target);
  1346. }
  1347. static ssize_t store_rxbuf_min(struct device *dev,
  1348. struct device_attribute *attr,
  1349. const char *buf, size_t len)
  1350. {
  1351. struct net_device *netdev = to_net_dev(dev);
  1352. struct netfront_info *np = netdev_priv(netdev);
  1353. char *endp;
  1354. unsigned long target;
  1355. if (!capable(CAP_NET_ADMIN))
  1356. return -EPERM;
  1357. target = simple_strtoul(buf, &endp, 0);
  1358. if (endp == buf)
  1359. return -EBADMSG;
  1360. if (target < RX_MIN_TARGET)
  1361. target = RX_MIN_TARGET;
  1362. if (target > RX_MAX_TARGET)
  1363. target = RX_MAX_TARGET;
  1364. spin_lock_bh(&np->rx_lock);
  1365. if (target > np->rx_max_target)
  1366. np->rx_max_target = target;
  1367. np->rx_min_target = target;
  1368. if (target > np->rx_target)
  1369. np->rx_target = target;
  1370. xennet_alloc_rx_buffers(netdev);
  1371. spin_unlock_bh(&np->rx_lock);
  1372. return len;
  1373. }
  1374. static ssize_t show_rxbuf_max(struct device *dev,
  1375. struct device_attribute *attr, char *buf)
  1376. {
  1377. struct net_device *netdev = to_net_dev(dev);
  1378. struct netfront_info *info = netdev_priv(netdev);
  1379. return sprintf(buf, "%u\n", info->rx_max_target);
  1380. }
  1381. static ssize_t store_rxbuf_max(struct device *dev,
  1382. struct device_attribute *attr,
  1383. const char *buf, size_t len)
  1384. {
  1385. struct net_device *netdev = to_net_dev(dev);
  1386. struct netfront_info *np = netdev_priv(netdev);
  1387. char *endp;
  1388. unsigned long target;
  1389. if (!capable(CAP_NET_ADMIN))
  1390. return -EPERM;
  1391. target = simple_strtoul(buf, &endp, 0);
  1392. if (endp == buf)
  1393. return -EBADMSG;
  1394. if (target < RX_MIN_TARGET)
  1395. target = RX_MIN_TARGET;
  1396. if (target > RX_MAX_TARGET)
  1397. target = RX_MAX_TARGET;
  1398. spin_lock_bh(&np->rx_lock);
  1399. if (target < np->rx_min_target)
  1400. np->rx_min_target = target;
  1401. np->rx_max_target = target;
  1402. if (target < np->rx_target)
  1403. np->rx_target = target;
  1404. xennet_alloc_rx_buffers(netdev);
  1405. spin_unlock_bh(&np->rx_lock);
  1406. return len;
  1407. }
  1408. static ssize_t show_rxbuf_cur(struct device *dev,
  1409. struct device_attribute *attr, char *buf)
  1410. {
  1411. struct net_device *netdev = to_net_dev(dev);
  1412. struct netfront_info *info = netdev_priv(netdev);
  1413. return sprintf(buf, "%u\n", info->rx_target);
  1414. }
  1415. static struct device_attribute xennet_attrs[] = {
  1416. __ATTR(rxbuf_min, S_IRUGO|S_IWUSR, show_rxbuf_min, store_rxbuf_min),
  1417. __ATTR(rxbuf_max, S_IRUGO|S_IWUSR, show_rxbuf_max, store_rxbuf_max),
  1418. __ATTR(rxbuf_cur, S_IRUGO, show_rxbuf_cur, NULL),
  1419. };
  1420. static int xennet_sysfs_addif(struct net_device *netdev)
  1421. {
  1422. int i;
  1423. int err;
  1424. for (i = 0; i < ARRAY_SIZE(xennet_attrs); i++) {
  1425. err = device_create_file(&netdev->dev,
  1426. &xennet_attrs[i]);
  1427. if (err)
  1428. goto fail;
  1429. }
  1430. return 0;
  1431. fail:
  1432. while (--i >= 0)
  1433. device_remove_file(&netdev->dev, &xennet_attrs[i]);
  1434. return err;
  1435. }
  1436. static void xennet_sysfs_delif(struct net_device *netdev)
  1437. {
  1438. int i;
  1439. for (i = 0; i < ARRAY_SIZE(xennet_attrs); i++)
  1440. device_remove_file(&netdev->dev, &xennet_attrs[i]);
  1441. }
  1442. #endif /* CONFIG_SYSFS */
  1443. static struct xenbus_device_id netfront_ids[] = {
  1444. { "vif" },
  1445. { "" }
  1446. };
  1447. static int __devexit xennet_remove(struct xenbus_device *dev)
  1448. {
  1449. struct netfront_info *info = dev->dev.driver_data;
  1450. dev_dbg(&dev->dev, "%s\n", dev->nodename);
  1451. unregister_netdev(info->netdev);
  1452. xennet_disconnect_backend(info);
  1453. del_timer_sync(&info->rx_refill_timer);
  1454. xennet_sysfs_delif(info->netdev);
  1455. free_netdev(info->netdev);
  1456. return 0;
  1457. }
  1458. static struct xenbus_driver netfront_driver = {
  1459. .name = "vif",
  1460. .owner = THIS_MODULE,
  1461. .ids = netfront_ids,
  1462. .probe = netfront_probe,
  1463. .remove = __devexit_p(xennet_remove),
  1464. .resume = netfront_resume,
  1465. .otherend_changed = backend_changed,
  1466. };
  1467. static int __init netif_init(void)
  1468. {
  1469. if (!xen_domain())
  1470. return -ENODEV;
  1471. if (xen_initial_domain())
  1472. return 0;
  1473. printk(KERN_INFO "Initialising Xen virtual ethernet driver.\n");
  1474. return xenbus_register_frontend(&netfront_driver);
  1475. }
  1476. module_init(netif_init);
  1477. static void __exit netif_exit(void)
  1478. {
  1479. if (xen_initial_domain())
  1480. return;
  1481. xenbus_unregister_driver(&netfront_driver);
  1482. }
  1483. module_exit(netif_exit);
  1484. MODULE_DESCRIPTION("Xen virtual network device frontend");
  1485. MODULE_LICENSE("GPL");
  1486. MODULE_ALIAS("xen:vif");
  1487. MODULE_ALIAS("xennet");