Lines Matching +full:queue +full:- +full:rx

4  * Copyright (c) 2002-2005, K A Fraser
81 #define NETFRONT_SKB_CB(skb) ((struct netfront_cb *)((skb)->cb))
88 /* Minimum number of Rx slots (includes slot for GSO metadata). */
91 /* Queue name is interface name with "-qNNN" appended */
94 /* IRQ name is queue name with "-tx" or "-rx" appended */
108 unsigned int id; /* Queue ID, 0-based */
109 char name[QUEUE_NAME_SIZE]; /* DEVNAME-qN */
122 char tx_irq_name[IRQ_NAME_SIZE]; /* DEVNAME-qN-tx */
123 char rx_irq_name[IRQ_NAME_SIZE]; /* DEVNAME-qN-rx */
130 * {tx,rx}_skbs store outstanding skbuffs. Free tx_skb entries
144 struct xen_netif_rx_front_ring rx; member
166 /* Multi-queue support */
187 struct xen_netif_rx_response rx; member
188 struct xen_netif_extra_info extras[XEN_NETIF_EXTRA_TYPE_MAX - 1];
215 return idx & (NET_RX_RING_SIZE - 1); in xennet_rxidx()
218 static struct sk_buff *xennet_get_rx_skb(struct netfront_queue *queue, in xennet_get_rx_skb() argument
222 struct sk_buff *skb = queue->rx_skbs[i]; in xennet_get_rx_skb()
223 queue->rx_skbs[i] = NULL; in xennet_get_rx_skb()
227 static grant_ref_t xennet_get_rx_ref(struct netfront_queue *queue, in xennet_get_rx_ref() argument
231 grant_ref_t ref = queue->grant_rx_ref[i]; in xennet_get_rx_ref()
232 queue->grant_rx_ref[i] = INVALID_GRANT_REF; in xennet_get_rx_ref()
242 return dev->features & NETIF_F_SG; in xennet_can_sg()
248 struct netfront_queue *queue = from_timer(queue, t, rx_refill_timer); in rx_refill_timeout() local
249 napi_schedule(&queue->napi); in rx_refill_timeout()
252 static int netfront_tx_slot_available(struct netfront_queue *queue) in netfront_tx_slot_available() argument
254 return (queue->tx.req_prod_pvt - queue->tx.rsp_cons) < in netfront_tx_slot_available()
255 (NET_TX_RING_SIZE - XEN_NETIF_NR_SLOTS_MIN - 1); in netfront_tx_slot_available()
258 static void xennet_maybe_wake_tx(struct netfront_queue *queue) in xennet_maybe_wake_tx() argument
260 struct net_device *dev = queue->info->netdev; in xennet_maybe_wake_tx()
261 struct netdev_queue *dev_queue = netdev_get_tx_queue(dev, queue->id); in xennet_maybe_wake_tx()
264 netfront_tx_slot_available(queue) && in xennet_maybe_wake_tx()
266 netif_tx_wake_queue(netdev_get_tx_queue(dev, queue->id)); in xennet_maybe_wake_tx()
270 static struct sk_buff *xennet_alloc_one_rx_buffer(struct netfront_queue *queue) in xennet_alloc_one_rx_buffer() argument
275 skb = __netdev_alloc_skb(queue->info->netdev, in xennet_alloc_one_rx_buffer()
281 page = page_pool_alloc_pages(queue->page_pool, in xennet_alloc_one_rx_buffer()
291 skb->dev = queue->info->netdev; in xennet_alloc_one_rx_buffer()
297 static void xennet_alloc_rx_buffers(struct netfront_queue *queue) in xennet_alloc_rx_buffers() argument
299 RING_IDX req_prod = queue->rx.req_prod_pvt; in xennet_alloc_rx_buffers()
303 if (unlikely(!netif_carrier_ok(queue->info->netdev))) in xennet_alloc_rx_buffers()
306 for (req_prod = queue->rx.req_prod_pvt; in xennet_alloc_rx_buffers()
307 req_prod - queue->rx.rsp_cons < NET_RX_RING_SIZE; in xennet_alloc_rx_buffers()
315 skb = xennet_alloc_one_rx_buffer(queue); in xennet_alloc_rx_buffers()
317 err = -ENOMEM; in xennet_alloc_rx_buffers()
323 BUG_ON(queue->rx_skbs[id]); in xennet_alloc_rx_buffers()
324 queue->rx_skbs[id] = skb; in xennet_alloc_rx_buffers()
326 ref = gnttab_claim_grant_reference(&queue->gref_rx_head); in xennet_alloc_rx_buffers()
328 queue->grant_rx_ref[id] = ref; in xennet_alloc_rx_buffers()
330 page = skb_frag_page(&skb_shinfo(skb)->frags[0]); in xennet_alloc_rx_buffers()
332 req = RING_GET_REQUEST(&queue->rx, req_prod); in xennet_alloc_rx_buffers()
334 queue->info->xbdev->otherend_id, in xennet_alloc_rx_buffers()
337 req->id = id; in xennet_alloc_rx_buffers()
338 req->gref = ref; in xennet_alloc_rx_buffers()
341 queue->rx.req_prod_pvt = req_prod; in xennet_alloc_rx_buffers()
348 if (req_prod - queue->rx.rsp_cons < NET_RX_SLOTS_MIN || in xennet_alloc_rx_buffers()
350 mod_timer(&queue->rx_refill_timer, jiffies + (HZ/10)); in xennet_alloc_rx_buffers()
354 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->rx, notify); in xennet_alloc_rx_buffers()
356 notify_remote_via_irq(queue->rx_irq); in xennet_alloc_rx_buffers()
362 unsigned int num_queues = dev->real_num_tx_queues; in xennet_open()
364 struct netfront_queue *queue = NULL; in xennet_open() local
366 if (!np->queues || np->broken) in xennet_open()
367 return -ENODEV; in xennet_open()
370 queue = &np->queues[i]; in xennet_open()
371 napi_enable(&queue->napi); in xennet_open()
373 spin_lock_bh(&queue->rx_lock); in xennet_open()
375 xennet_alloc_rx_buffers(queue); in xennet_open()
376 queue->rx.sring->rsp_event = queue->rx.rsp_cons + 1; in xennet_open()
377 if (RING_HAS_UNCONSUMED_RESPONSES(&queue->rx)) in xennet_open()
378 napi_schedule(&queue->napi); in xennet_open()
380 spin_unlock_bh(&queue->rx_lock); in xennet_open()
388 static bool xennet_tx_buf_gc(struct netfront_queue *queue) in xennet_tx_buf_gc() argument
395 const struct device *dev = &queue->info->netdev->dev; in xennet_tx_buf_gc()
397 BUG_ON(!netif_carrier_ok(queue->info->netdev)); in xennet_tx_buf_gc()
400 prod = queue->tx.sring->rsp_prod; in xennet_tx_buf_gc()
401 if (RING_RESPONSE_PROD_OVERFLOW(&queue->tx, prod)) { in xennet_tx_buf_gc()
403 prod - queue->tx.rsp_cons); in xennet_tx_buf_gc()
408 for (cons = queue->tx.rsp_cons; cons != prod; cons++) { in xennet_tx_buf_gc()
413 RING_COPY_RESPONSE(&queue->tx, cons, &txrsp); in xennet_tx_buf_gc()
418 if (id >= RING_SIZE(&queue->tx)) { in xennet_tx_buf_gc()
424 if (queue->tx_link[id] != TX_PENDING) { in xennet_tx_buf_gc()
430 queue->tx_link[id] = TX_LINK_NONE; in xennet_tx_buf_gc()
431 skb = queue->tx_skbs[id]; in xennet_tx_buf_gc()
432 queue->tx_skbs[id] = NULL; in xennet_tx_buf_gc()
434 queue->grant_tx_ref[id]))) { in xennet_tx_buf_gc()
440 &queue->gref_tx_head, queue->grant_tx_ref[id]); in xennet_tx_buf_gc()
441 queue->grant_tx_ref[id] = INVALID_GRANT_REF; in xennet_tx_buf_gc()
442 queue->grant_tx_page[id] = NULL; in xennet_tx_buf_gc()
443 add_id_to_list(&queue->tx_skb_freelist, queue->tx_link, id); in xennet_tx_buf_gc()
447 queue->tx.rsp_cons = prod; in xennet_tx_buf_gc()
449 RING_FINAL_CHECK_FOR_RESPONSES(&queue->tx, more_to_do); in xennet_tx_buf_gc()
452 xennet_maybe_wake_tx(queue); in xennet_tx_buf_gc()
457 queue->info->broken = true; in xennet_tx_buf_gc()
464 struct netfront_queue *queue; member
480 struct page *page = info->page; in xennet_tx_setup_grant()
481 struct netfront_queue *queue = info->queue; in xennet_tx_setup_grant() local
482 struct sk_buff *skb = info->skb; in xennet_tx_setup_grant()
484 id = get_id_from_list(&queue->tx_skb_freelist, queue->tx_link); in xennet_tx_setup_grant()
485 tx = RING_GET_REQUEST(&queue->tx, queue->tx.req_prod_pvt++); in xennet_tx_setup_grant()
486 ref = gnttab_claim_grant_reference(&queue->gref_tx_head); in xennet_tx_setup_grant()
489 gnttab_grant_foreign_access_ref(ref, queue->info->xbdev->otherend_id, in xennet_tx_setup_grant()
492 queue->tx_skbs[id] = skb; in xennet_tx_setup_grant()
493 queue->grant_tx_page[id] = page; in xennet_tx_setup_grant()
494 queue->grant_tx_ref[id] = ref; in xennet_tx_setup_grant()
496 info->tx_local.id = id; in xennet_tx_setup_grant()
497 info->tx_local.gref = ref; in xennet_tx_setup_grant()
498 info->tx_local.offset = offset; in xennet_tx_setup_grant()
499 info->tx_local.size = len; in xennet_tx_setup_grant()
500 info->tx_local.flags = 0; in xennet_tx_setup_grant()
502 *tx = info->tx_local; in xennet_tx_setup_grant()
505 * Put the request in the pending queue, it will be set to be pending in xennet_tx_setup_grant()
508 add_id_to_list(&queue->tx_pend_queue, queue->tx_link, id); in xennet_tx_setup_grant()
510 info->tx = tx; in xennet_tx_setup_grant()
511 info->size += info->tx_local.size; in xennet_tx_setup_grant()
518 info->size = 0; in xennet_make_first_txreq()
520 gnttab_for_one_grant(info->page, offset, len, xennet_tx_setup_grant, info); in xennet_make_first_txreq()
522 return info->tx; in xennet_make_first_txreq()
530 info->tx->flags |= XEN_NETTXF_more_data; in xennet_make_one_txreq()
531 skb_get(info->skb); in xennet_make_one_txreq()
545 info->page = page; in xennet_make_txreqs()
546 info->size = 0; in xennet_make_txreqs()
554 len -= info->size; in xennet_make_txreqs()
564 int i, frags = skb_shinfo(skb)->nr_frags; in xennet_count_skb_slots()
567 slots = gnttab_count_grant(offset_in_page(skb->data), in xennet_count_skb_slots()
571 skb_frag_t *frag = skb_shinfo(skb)->frags + i; in xennet_count_skb_slots()
587 unsigned int num_queues = dev->real_num_tx_queues; in xennet_select_queue()
591 /* First, check if there is only one queue */ in xennet_select_queue()
602 static void xennet_mark_tx_pending(struct netfront_queue *queue) in xennet_mark_tx_pending() argument
606 while ((i = get_id_from_list(&queue->tx_pend_queue, queue->tx_link)) != in xennet_mark_tx_pending()
608 queue->tx_link[i] = TX_PENDING; in xennet_mark_tx_pending()
612 struct netfront_queue *queue, in xennet_xdp_xmit_one() argument
616 struct netfront_stats *tx_stats = this_cpu_ptr(np->tx_stats); in xennet_xdp_xmit_one()
618 .queue = queue, in xennet_xdp_xmit_one()
620 .page = virt_to_page(xdpf->data), in xennet_xdp_xmit_one()
625 offset_in_page(xdpf->data), in xennet_xdp_xmit_one()
626 xdpf->len); in xennet_xdp_xmit_one()
628 xennet_mark_tx_pending(queue); in xennet_xdp_xmit_one()
630 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->tx, notify); in xennet_xdp_xmit_one()
632 notify_remote_via_irq(queue->tx_irq); in xennet_xdp_xmit_one()
634 u64_stats_update_begin(&tx_stats->syncp); in xennet_xdp_xmit_one()
635 tx_stats->bytes += xdpf->len; in xennet_xdp_xmit_one()
636 tx_stats->packets++; in xennet_xdp_xmit_one()
637 u64_stats_update_end(&tx_stats->syncp); in xennet_xdp_xmit_one()
639 xennet_tx_buf_gc(queue); in xennet_xdp_xmit_one()
647 unsigned int num_queues = dev->real_num_tx_queues; in xennet_xdp_xmit()
649 struct netfront_queue *queue = NULL; in xennet_xdp_xmit() local
654 if (unlikely(np->broken)) in xennet_xdp_xmit()
655 return -ENODEV; in xennet_xdp_xmit()
657 return -EINVAL; in xennet_xdp_xmit()
659 queue = &np->queues[smp_processor_id() % num_queues]; in xennet_xdp_xmit()
661 spin_lock_irqsave(&queue->tx_lock, irq_flags); in xennet_xdp_xmit()
667 if (xennet_xdp_xmit_one(dev, queue, xdpf)) in xennet_xdp_xmit()
671 spin_unlock_irqrestore(&queue->tx_lock, irq_flags); in xennet_xdp_xmit()
680 unsigned int size = ALIGN(skb_end_offset(skb) + skb->data_len, in bounce_skb()
687 if (!IS_ALIGNED((uintptr_t)n->head, XEN_PAGE_SIZE)) { in bounce_skb()
696 skb_put(n, skb->len); in bounce_skb()
698 BUG_ON(skb_copy_bits(skb, -headerlen, n->head, headerlen + skb->len)); in bounce_skb()
709 struct netfront_stats *tx_stats = this_cpu_ptr(np->tx_stats); in xennet_start_xmit()
718 struct netfront_queue *queue = NULL; in xennet_start_xmit() local
720 unsigned int num_queues = dev->real_num_tx_queues; in xennet_start_xmit()
727 if (unlikely(np->broken)) in xennet_start_xmit()
729 /* Determine which queue to transmit this SKB on */ in xennet_start_xmit()
731 queue = &np->queues[queue_index]; in xennet_start_xmit()
733 /* If skb->len is too big for wire format, drop skb and alert in xennet_start_xmit()
736 if (unlikely(skb->len > XEN_NETIF_MAX_TX_SIZE)) { in xennet_start_xmit()
738 "xennet: skb->len = %u, too big for wire format\n", in xennet_start_xmit()
739 skb->len); in xennet_start_xmit()
746 slots, skb->len); in xennet_start_xmit()
751 page = virt_to_page(skb->data); in xennet_start_xmit()
752 offset = offset_in_page(skb->data); in xennet_start_xmit()
761 if (np->bounce || unlikely(PAGE_SIZE - offset < ETH_HLEN)) { in xennet_start_xmit()
767 page = virt_to_page(skb->data); in xennet_start_xmit()
768 offset = offset_in_page(skb->data); in xennet_start_xmit()
773 spin_lock_irqsave(&queue->tx_lock, flags); in xennet_start_xmit()
778 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_start_xmit()
783 info.queue = queue; in xennet_start_xmit()
792 len -= info.tx_local.size; in xennet_start_xmit()
794 if (skb->ip_summed == CHECKSUM_PARTIAL) in xennet_start_xmit()
796 first_tx->flags |= XEN_NETTXF_csum_blank | in xennet_start_xmit()
798 else if (skb->ip_summed == CHECKSUM_UNNECESSARY) in xennet_start_xmit()
800 first_tx->flags |= XEN_NETTXF_data_validated; in xennet_start_xmit()
803 if (skb_shinfo(skb)->gso_size) { in xennet_start_xmit()
807 RING_GET_REQUEST(&queue->tx, queue->tx.req_prod_pvt++); in xennet_start_xmit()
809 first_tx->flags |= XEN_NETTXF_extra_info; in xennet_start_xmit()
811 gso->u.gso.size = skb_shinfo(skb)->gso_size; in xennet_start_xmit()
812 gso->u.gso.type = (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV6) ? in xennet_start_xmit()
815 gso->u.gso.pad = 0; in xennet_start_xmit()
816 gso->u.gso.features = 0; in xennet_start_xmit()
818 gso->type = XEN_NETIF_EXTRA_TYPE_GSO; in xennet_start_xmit()
819 gso->flags = 0; in xennet_start_xmit()
826 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { in xennet_start_xmit()
827 skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; in xennet_start_xmit()
834 first_tx->size = skb->len; in xennet_start_xmit()
839 xennet_mark_tx_pending(queue); in xennet_start_xmit()
841 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->tx, notify); in xennet_start_xmit()
843 notify_remote_via_irq(queue->tx_irq); in xennet_start_xmit()
845 u64_stats_update_begin(&tx_stats->syncp); in xennet_start_xmit()
846 tx_stats->bytes += skb->len; in xennet_start_xmit()
847 tx_stats->packets++; in xennet_start_xmit()
848 u64_stats_update_end(&tx_stats->syncp); in xennet_start_xmit()
851 xennet_tx_buf_gc(queue); in xennet_start_xmit()
853 if (!netfront_tx_slot_available(queue)) in xennet_start_xmit()
854 netif_tx_stop_queue(netdev_get_tx_queue(dev, queue->id)); in xennet_start_xmit()
856 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_start_xmit()
861 dev->stats.tx_dropped++; in xennet_start_xmit()
869 unsigned int num_queues = dev->real_num_tx_queues; in xennet_close()
871 struct netfront_queue *queue; in xennet_close() local
872 netif_tx_stop_all_queues(np->netdev); in xennet_close()
874 queue = &np->queues[i]; in xennet_close()
875 napi_disable(&queue->napi); in xennet_close()
884 for (i = 0; i < info->netdev->real_num_tx_queues; i++) { in xennet_destroy_queues()
885 struct netfront_queue *queue = &info->queues[i]; in xennet_destroy_queues() local
887 if (netif_running(info->netdev)) in xennet_destroy_queues()
888 napi_disable(&queue->napi); in xennet_destroy_queues()
889 netif_napi_del(&queue->napi); in xennet_destroy_queues()
892 kfree(info->queues); in xennet_destroy_queues()
893 info->queues = NULL; in xennet_destroy_queues()
902 static void xennet_set_rx_rsp_cons(struct netfront_queue *queue, RING_IDX val) in xennet_set_rx_rsp_cons() argument
906 spin_lock_irqsave(&queue->rx_cons_lock, flags); in xennet_set_rx_rsp_cons()
907 queue->rx.rsp_cons = val; in xennet_set_rx_rsp_cons()
908 queue->rx_rsp_unconsumed = XEN_RING_NR_UNCONSUMED_RESPONSES(&queue->rx); in xennet_set_rx_rsp_cons()
909 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_set_rx_rsp_cons()
912 static void xennet_move_rx_slot(struct netfront_queue *queue, struct sk_buff *skb, in xennet_move_rx_slot() argument
915 int new = xennet_rxidx(queue->rx.req_prod_pvt); in xennet_move_rx_slot()
917 BUG_ON(queue->rx_skbs[new]); in xennet_move_rx_slot()
918 queue->rx_skbs[new] = skb; in xennet_move_rx_slot()
919 queue->grant_rx_ref[new] = ref; in xennet_move_rx_slot()
920 RING_GET_REQUEST(&queue->rx, queue->rx.req_prod_pvt)->id = new; in xennet_move_rx_slot()
921 RING_GET_REQUEST(&queue->rx, queue->rx.req_prod_pvt)->gref = ref; in xennet_move_rx_slot()
922 queue->rx.req_prod_pvt++; in xennet_move_rx_slot()
925 static int xennet_get_extras(struct netfront_queue *queue, in xennet_get_extras() argument
931 struct device *dev = &queue->info->netdev->dev; in xennet_get_extras()
932 RING_IDX cons = queue->rx.rsp_cons; in xennet_get_extras()
942 err = -EBADR; in xennet_get_extras()
946 RING_COPY_RESPONSE(&queue->rx, ++cons, &extra); in xennet_get_extras()
953 err = -EINVAL; in xennet_get_extras()
955 extras[extra.type - 1] = extra; in xennet_get_extras()
958 skb = xennet_get_rx_skb(queue, cons); in xennet_get_extras()
959 ref = xennet_get_rx_ref(queue, cons); in xennet_get_extras()
960 xennet_move_rx_slot(queue, skb, ref); in xennet_get_extras()
963 xennet_set_rx_rsp_cons(queue, cons); in xennet_get_extras()
967 static u32 xennet_run_xdp(struct netfront_queue *queue, struct page *pdata, in xennet_run_xdp() argument
968 struct xen_netif_rx_response *rx, struct bpf_prog *prog, in xennet_run_xdp() argument
972 u32 len = rx->status; in xennet_run_xdp()
976 xdp_init_buff(xdp, XEN_PAGE_SIZE - XDP_PACKET_HEADROOM, in xennet_run_xdp()
977 &queue->xdp_rxq); in xennet_run_xdp()
986 err = xennet_xdp_xmit(queue->info->netdev, 1, &xdpf, 0); in xennet_run_xdp()
990 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
994 err = xdp_do_redirect(queue->info->netdev, xdp, prog); in xennet_run_xdp()
997 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
1004 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
1008 bpf_warn_invalid_xdp_action(queue->info->netdev, prog, act); in xennet_run_xdp()
1014 static int xennet_get_responses(struct netfront_queue *queue, in xennet_get_responses() argument
1019 struct xen_netif_rx_response *rx = &rinfo->rx, rx_local; in xennet_get_responses() local
1020 int max = XEN_NETIF_NR_SLOTS_MIN + (rx->status <= RX_COPY_THRESHOLD); in xennet_get_responses()
1021 RING_IDX cons = queue->rx.rsp_cons; in xennet_get_responses()
1022 struct sk_buff *skb = xennet_get_rx_skb(queue, cons); in xennet_get_responses()
1023 struct xen_netif_extra_info *extras = rinfo->extras; in xennet_get_responses()
1024 grant_ref_t ref = xennet_get_rx_ref(queue, cons); in xennet_get_responses()
1025 struct device *dev = &queue->info->netdev->dev; in xennet_get_responses()
1032 if (rx->flags & XEN_NETRXF_extra_info) { in xennet_get_responses()
1033 err = xennet_get_extras(queue, extras, rp); in xennet_get_responses()
1035 if (extras[XEN_NETIF_EXTRA_TYPE_XDP - 1].type) { in xennet_get_responses()
1038 xdp = &extras[XEN_NETIF_EXTRA_TYPE_XDP - 1]; in xennet_get_responses()
1039 rx->offset = xdp->u.xdp.headroom; in xennet_get_responses()
1042 cons = queue->rx.rsp_cons; in xennet_get_responses()
1053 dev_warn(dev, "Bad rx response id %d.\n", in xennet_get_responses()
1054 rx->id); in xennet_get_responses()
1055 err = -EINVAL; in xennet_get_responses()
1059 if (unlikely(rx->status < 0 || in xennet_get_responses()
1060 rx->offset + rx->status > XEN_PAGE_SIZE)) { in xennet_get_responses()
1062 dev_warn(dev, "rx->offset: %u, size: %d\n", in xennet_get_responses()
1063 rx->offset, rx->status); in xennet_get_responses()
1064 xennet_move_rx_slot(queue, skb, ref); in xennet_get_responses()
1065 err = -EINVAL; in xennet_get_responses()
1072 queue->info->broken = true; in xennet_get_responses()
1074 return -EINVAL; in xennet_get_responses()
1077 gnttab_release_grant_reference(&queue->gref_rx_head, ref); in xennet_get_responses()
1080 xdp_prog = rcu_dereference(queue->xdp_prog); in xennet_get_responses()
1082 if (!(rx->flags & XEN_NETRXF_more_data)) { in xennet_get_responses()
1084 verdict = xennet_run_xdp(queue, in xennet_get_responses()
1085 skb_frag_page(&skb_shinfo(skb)->frags[0]), in xennet_get_responses()
1086 rx, xdp_prog, &xdp, need_xdp_flush); in xennet_get_responses()
1088 err = -EINVAL; in xennet_get_responses()
1091 err = -EINVAL; in xennet_get_responses()
1099 if (!(rx->flags & XEN_NETRXF_more_data)) in xennet_get_responses()
1105 err = -ENOENT; in xennet_get_responses()
1109 RING_COPY_RESPONSE(&queue->rx, cons + slots, &rx_local); in xennet_get_responses()
1110 rx = &rx_local; in xennet_get_responses()
1111 skb = xennet_get_rx_skb(queue, cons + slots); in xennet_get_responses()
1112 ref = xennet_get_rx_ref(queue, cons + slots); in xennet_get_responses()
1119 err = -E2BIG; in xennet_get_responses()
1123 xennet_set_rx_rsp_cons(queue, cons + slots); in xennet_get_responses()
1131 if (!gso->u.gso.size) { in xennet_set_skb_gso()
1134 return -EINVAL; in xennet_set_skb_gso()
1137 if (gso->u.gso.type != XEN_NETIF_GSO_TYPE_TCPV4 && in xennet_set_skb_gso()
1138 gso->u.gso.type != XEN_NETIF_GSO_TYPE_TCPV6) { in xennet_set_skb_gso()
1140 pr_warn("Bad GSO type %d\n", gso->u.gso.type); in xennet_set_skb_gso()
1141 return -EINVAL; in xennet_set_skb_gso()
1144 skb_shinfo(skb)->gso_size = gso->u.gso.size; in xennet_set_skb_gso()
1145 skb_shinfo(skb)->gso_type = in xennet_set_skb_gso()
1146 (gso->u.gso.type == XEN_NETIF_GSO_TYPE_TCPV4) ? in xennet_set_skb_gso()
1151 skb_shinfo(skb)->gso_type |= SKB_GSO_DODGY; in xennet_set_skb_gso()
1152 skb_shinfo(skb)->gso_segs = 0; in xennet_set_skb_gso()
1157 static int xennet_fill_frags(struct netfront_queue *queue, in xennet_fill_frags() argument
1161 RING_IDX cons = queue->rx.rsp_cons; in xennet_fill_frags()
1165 struct xen_netif_rx_response rx; in xennet_fill_frags() local
1166 skb_frag_t *nfrag = &skb_shinfo(nskb)->frags[0]; in xennet_fill_frags()
1168 RING_COPY_RESPONSE(&queue->rx, ++cons, &rx); in xennet_fill_frags()
1170 if (skb_shinfo(skb)->nr_frags == MAX_SKB_FRAGS) { in xennet_fill_frags()
1171 unsigned int pull_to = NETFRONT_SKB_CB(skb)->pull_to; in xennet_fill_frags()
1174 __pskb_pull_tail(skb, pull_to - skb_headlen(skb)); in xennet_fill_frags()
1176 if (unlikely(skb_shinfo(skb)->nr_frags >= MAX_SKB_FRAGS)) { in xennet_fill_frags()
1177 xennet_set_rx_rsp_cons(queue, in xennet_fill_frags()
1180 return -ENOENT; in xennet_fill_frags()
1183 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, in xennet_fill_frags()
1185 rx.offset, rx.status, PAGE_SIZE); in xennet_fill_frags()
1187 skb_shinfo(nskb)->nr_frags = 0; in xennet_fill_frags()
1191 xennet_set_rx_rsp_cons(queue, cons); in xennet_fill_frags()
1206 if (skb->ip_summed != CHECKSUM_PARTIAL && skb_is_gso(skb)) { in checksum_setup()
1208 atomic_inc(&np->rx_gso_checksum_fixup); in checksum_setup()
1209 skb->ip_summed = CHECKSUM_PARTIAL; in checksum_setup()
1213 /* A non-CHECKSUM_PARTIAL SKB does not require setup. */ in checksum_setup()
1214 if (skb->ip_summed != CHECKSUM_PARTIAL) in checksum_setup()
1220 static int handle_incoming_queue(struct netfront_queue *queue, in handle_incoming_queue() argument
1223 struct netfront_stats *rx_stats = this_cpu_ptr(queue->info->rx_stats); in handle_incoming_queue()
1228 int pull_to = NETFRONT_SKB_CB(skb)->pull_to; in handle_incoming_queue()
1231 __pskb_pull_tail(skb, pull_to - skb_headlen(skb)); in handle_incoming_queue()
1234 skb->protocol = eth_type_trans(skb, queue->info->netdev); in handle_incoming_queue()
1237 if (checksum_setup(queue->info->netdev, skb)) { in handle_incoming_queue()
1240 queue->info->netdev->stats.rx_errors++; in handle_incoming_queue()
1244 u64_stats_update_begin(&rx_stats->syncp); in handle_incoming_queue()
1245 rx_stats->packets++; in handle_incoming_queue()
1246 rx_stats->bytes += skb->len; in handle_incoming_queue()
1247 u64_stats_update_end(&rx_stats->syncp); in handle_incoming_queue()
1250 napi_gro_receive(&queue->napi, skb); in handle_incoming_queue()
1258 struct netfront_queue *queue = container_of(napi, struct netfront_queue, napi); in xennet_poll() local
1259 struct net_device *dev = queue->info->netdev; in xennet_poll()
1262 struct xen_netif_rx_response *rx = &rinfo.rx; in xennet_poll() local
1272 spin_lock(&queue->rx_lock); in xennet_poll()
1278 rp = queue->rx.sring->rsp_prod; in xennet_poll()
1279 if (RING_RESPONSE_PROD_OVERFLOW(&queue->rx, rp)) { in xennet_poll()
1280 dev_alert(&dev->dev, "Illegal number of responses %u\n", in xennet_poll()
1281 rp - queue->rx.rsp_cons); in xennet_poll()
1282 queue->info->broken = true; in xennet_poll()
1283 spin_unlock(&queue->rx_lock); in xennet_poll()
1288 i = queue->rx.rsp_cons; in xennet_poll()
1291 RING_COPY_RESPONSE(&queue->rx, i, rx); in xennet_poll()
1294 err = xennet_get_responses(queue, &rinfo, rp, &tmpq, in xennet_poll()
1298 if (queue->info->broken) { in xennet_poll()
1299 spin_unlock(&queue->rx_lock); in xennet_poll()
1305 dev->stats.rx_errors++; in xennet_poll()
1306 i = queue->rx.rsp_cons; in xennet_poll()
1312 if (extras[XEN_NETIF_EXTRA_TYPE_GSO - 1].type) { in xennet_poll()
1314 gso = &extras[XEN_NETIF_EXTRA_TYPE_GSO - 1]; in xennet_poll()
1318 xennet_set_rx_rsp_cons(queue, in xennet_poll()
1319 queue->rx.rsp_cons + in xennet_poll()
1325 NETFRONT_SKB_CB(skb)->pull_to = rx->status; in xennet_poll()
1326 if (NETFRONT_SKB_CB(skb)->pull_to > RX_COPY_THRESHOLD) in xennet_poll()
1327 NETFRONT_SKB_CB(skb)->pull_to = RX_COPY_THRESHOLD; in xennet_poll()
1329 skb_frag_off_set(&skb_shinfo(skb)->frags[0], rx->offset); in xennet_poll()
1330 skb_frag_size_set(&skb_shinfo(skb)->frags[0], rx->status); in xennet_poll()
1331 skb->data_len = rx->status; in xennet_poll()
1332 skb->len += rx->status; in xennet_poll()
1334 if (unlikely(xennet_fill_frags(queue, skb, &tmpq))) in xennet_poll()
1337 if (rx->flags & XEN_NETRXF_csum_blank) in xennet_poll()
1338 skb->ip_summed = CHECKSUM_PARTIAL; in xennet_poll()
1339 else if (rx->flags & XEN_NETRXF_data_validated) in xennet_poll()
1340 skb->ip_summed = CHECKSUM_UNNECESSARY; in xennet_poll()
1344 i = queue->rx.rsp_cons + 1; in xennet_poll()
1345 xennet_set_rx_rsp_cons(queue, i); in xennet_poll()
1353 work_done -= handle_incoming_queue(queue, &rxq); in xennet_poll()
1355 xennet_alloc_rx_buffers(queue); in xennet_poll()
1362 RING_FINAL_CHECK_FOR_RESPONSES(&queue->rx, more_to_do); in xennet_poll()
1367 spin_unlock(&queue->rx_lock); in xennet_poll()
1377 return -EINVAL; in xennet_change_mtu()
1378 dev->mtu = mtu; in xennet_change_mtu()
1389 struct netfront_stats *rx_stats = per_cpu_ptr(np->rx_stats, cpu); in xennet_get_stats64()
1390 struct netfront_stats *tx_stats = per_cpu_ptr(np->tx_stats, cpu); in xennet_get_stats64()
1395 start = u64_stats_fetch_begin(&tx_stats->syncp); in xennet_get_stats64()
1396 tx_packets = tx_stats->packets; in xennet_get_stats64()
1397 tx_bytes = tx_stats->bytes; in xennet_get_stats64()
1398 } while (u64_stats_fetch_retry(&tx_stats->syncp, start)); in xennet_get_stats64()
1401 start = u64_stats_fetch_begin(&rx_stats->syncp); in xennet_get_stats64()
1402 rx_packets = rx_stats->packets; in xennet_get_stats64()
1403 rx_bytes = rx_stats->bytes; in xennet_get_stats64()
1404 } while (u64_stats_fetch_retry(&rx_stats->syncp, start)); in xennet_get_stats64()
1406 tot->rx_packets += rx_packets; in xennet_get_stats64()
1407 tot->tx_packets += tx_packets; in xennet_get_stats64()
1408 tot->rx_bytes += rx_bytes; in xennet_get_stats64()
1409 tot->tx_bytes += tx_bytes; in xennet_get_stats64()
1412 tot->rx_errors = dev->stats.rx_errors; in xennet_get_stats64()
1413 tot->tx_dropped = dev->stats.tx_dropped; in xennet_get_stats64()
1416 static void xennet_release_tx_bufs(struct netfront_queue *queue) in xennet_release_tx_bufs() argument
1423 if (!queue->tx_skbs[i]) in xennet_release_tx_bufs()
1426 skb = queue->tx_skbs[i]; in xennet_release_tx_bufs()
1427 queue->tx_skbs[i] = NULL; in xennet_release_tx_bufs()
1428 get_page(queue->grant_tx_page[i]); in xennet_release_tx_bufs()
1429 gnttab_end_foreign_access(queue->grant_tx_ref[i], in xennet_release_tx_bufs()
1430 queue->grant_tx_page[i]); in xennet_release_tx_bufs()
1431 queue->grant_tx_page[i] = NULL; in xennet_release_tx_bufs()
1432 queue->grant_tx_ref[i] = INVALID_GRANT_REF; in xennet_release_tx_bufs()
1433 add_id_to_list(&queue->tx_skb_freelist, queue->tx_link, i); in xennet_release_tx_bufs()
1438 static void xennet_release_rx_bufs(struct netfront_queue *queue) in xennet_release_rx_bufs() argument
1442 spin_lock_bh(&queue->rx_lock); in xennet_release_rx_bufs()
1448 skb = queue->rx_skbs[id]; in xennet_release_rx_bufs()
1452 ref = queue->grant_rx_ref[id]; in xennet_release_rx_bufs()
1456 page = skb_frag_page(&skb_shinfo(skb)->frags[0]); in xennet_release_rx_bufs()
1463 queue->grant_rx_ref[id] = INVALID_GRANT_REF; in xennet_release_rx_bufs()
1468 spin_unlock_bh(&queue->rx_lock); in xennet_release_rx_bufs()
1477 !xenbus_read_unsigned(np->xbdev->otherend, "feature-sg", 0)) in xennet_fix_features()
1481 !xenbus_read_unsigned(np->xbdev->otherend, in xennet_fix_features()
1482 "feature-ipv6-csum-offload", 0)) in xennet_fix_features()
1486 !xenbus_read_unsigned(np->xbdev->otherend, "feature-gso-tcpv4", 0)) in xennet_fix_features()
1490 !xenbus_read_unsigned(np->xbdev->otherend, "feature-gso-tcpv6", 0)) in xennet_fix_features()
1499 if (!(features & NETIF_F_SG) && dev->mtu > ETH_DATA_LEN) { in xennet_set_features()
1501 dev->mtu = ETH_DATA_LEN; in xennet_set_features()
1507 static bool xennet_handle_tx(struct netfront_queue *queue, unsigned int *eoi) in xennet_handle_tx() argument
1511 if (unlikely(queue->info->broken)) in xennet_handle_tx()
1514 spin_lock_irqsave(&queue->tx_lock, flags); in xennet_handle_tx()
1515 if (xennet_tx_buf_gc(queue)) in xennet_handle_tx()
1517 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_handle_tx()
1532 static bool xennet_handle_rx(struct netfront_queue *queue, unsigned int *eoi) in xennet_handle_rx() argument
1537 if (unlikely(queue->info->broken)) in xennet_handle_rx()
1540 spin_lock_irqsave(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1541 work_queued = XEN_RING_NR_UNCONSUMED_RESPONSES(&queue->rx); in xennet_handle_rx()
1542 if (work_queued > queue->rx_rsp_unconsumed) { in xennet_handle_rx()
1543 queue->rx_rsp_unconsumed = work_queued; in xennet_handle_rx()
1545 } else if (unlikely(work_queued < queue->rx_rsp_unconsumed)) { in xennet_handle_rx()
1546 const struct device *dev = &queue->info->netdev->dev; in xennet_handle_rx()
1548 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1549 dev_alert(dev, "RX producer index going backwards\n"); in xennet_handle_rx()
1551 queue->info->broken = true; in xennet_handle_rx()
1554 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1556 if (likely(netif_carrier_ok(queue->info->netdev) && work_queued)) in xennet_handle_rx()
1557 napi_schedule(&queue->napi); in xennet_handle_rx()
1586 /* Poll each queue */ in xennet_poll_controller()
1588 unsigned int num_queues = dev->real_num_tx_queues; in xennet_poll_controller()
1591 if (info->broken) in xennet_poll_controller()
1595 xennet_interrupt(0, &info->queues[i]); in xennet_poll_controller()
1608 err = xenbus_printf(XBT_NIL, np->xbdev->nodename, in talk_to_netback_xdp()
1609 "xdp-headroom", "%hu", in talk_to_netback_xdp()
1612 pr_warn("Error writing xdp-headroom\n"); in talk_to_netback_xdp()
1620 unsigned long max_mtu = XEN_PAGE_SIZE - XDP_PACKET_HEADROOM; in xennet_xdp_set()
1625 if (dev->mtu > max_mtu) { in xennet_xdp_set()
1627 return -EINVAL; in xennet_xdp_set()
1630 if (!np->netback_has_xdp_headroom) in xennet_xdp_set()
1633 xenbus_switch_state(np->xbdev, XenbusStateReconfiguring); in xennet_xdp_set()
1642 xenbus_read_driver_state(np->xbdev->otherend) == in xennet_xdp_set()
1644 np->netfront_xdp_enabled = true; in xennet_xdp_set()
1646 old_prog = rtnl_dereference(np->queues[0].xdp_prog); in xennet_xdp_set()
1649 bpf_prog_add(prog, dev->real_num_tx_queues); in xennet_xdp_set()
1651 for (i = 0; i < dev->real_num_tx_queues; ++i) in xennet_xdp_set()
1652 rcu_assign_pointer(np->queues[i].xdp_prog, prog); in xennet_xdp_set()
1655 for (i = 0; i < dev->real_num_tx_queues; ++i) in xennet_xdp_set()
1658 xenbus_switch_state(np->xbdev, XenbusStateConnected); in xennet_xdp_set()
1667 if (np->broken) in xennet_xdp()
1668 return -ENODEV; in xennet_xdp()
1670 switch (xdp->command) { in xennet_xdp()
1672 return xennet_xdp_set(dev, xdp->prog, xdp->extack); in xennet_xdp()
1674 return -EINVAL; in xennet_xdp()
1701 free_percpu(np->rx_stats); in xennet_free_netdev()
1702 free_percpu(np->tx_stats); in xennet_free_netdev()
1714 return ERR_PTR(-ENOMEM); in xennet_create_dev()
1717 np->xbdev = dev; in xennet_create_dev()
1719 np->queues = NULL; in xennet_create_dev()
1721 err = -ENOMEM; in xennet_create_dev()
1722 np->rx_stats = netdev_alloc_pcpu_stats(struct netfront_stats); in xennet_create_dev()
1723 if (np->rx_stats == NULL) in xennet_create_dev()
1725 np->tx_stats = netdev_alloc_pcpu_stats(struct netfront_stats); in xennet_create_dev()
1726 if (np->tx_stats == NULL) in xennet_create_dev()
1729 netdev->netdev_ops = &xennet_netdev_ops; in xennet_create_dev()
1731 netdev->features = NETIF_F_IP_CSUM | NETIF_F_RXCSUM | in xennet_create_dev()
1733 netdev->hw_features = NETIF_F_SG | in xennet_create_dev()
1743 netdev->features |= netdev->hw_features; in xennet_create_dev()
1744 netdev->xdp_features = NETDEV_XDP_ACT_BASIC | NETDEV_XDP_ACT_REDIRECT | in xennet_create_dev()
1747 netdev->ethtool_ops = &xennet_ethtool_ops; in xennet_create_dev()
1748 netdev->min_mtu = ETH_MIN_MTU; in xennet_create_dev()
1749 netdev->max_mtu = XEN_NETIF_MAX_TX_SIZE; in xennet_create_dev()
1750 SET_NETDEV_DEV(netdev, &dev->dev); in xennet_create_dev()
1752 np->netdev = netdev; in xennet_create_dev()
1753 np->netfront_xdp_enabled = false; in xennet_create_dev()
1760 xenbus_read_driver_state(dev->otherend) != in xennet_create_dev()
1762 xenbus_read_driver_state(dev->otherend) != in xennet_create_dev()
1793 dev_set_drvdata(&dev->dev, info); in netfront_probe()
1795 info->netdev->sysfs_groups[0] = &xennet_dev_group; in netfront_probe()
1803 /* This frees the page as a side-effect */ in xennet_end_access()
1811 unsigned int num_queues = info->netdev->real_num_tx_queues; in xennet_disconnect_backend()
1813 netif_carrier_off(info->netdev); in xennet_disconnect_backend()
1815 for (i = 0; i < num_queues && info->queues; ++i) { in xennet_disconnect_backend()
1816 struct netfront_queue *queue = &info->queues[i]; in xennet_disconnect_backend() local
1818 del_timer_sync(&queue->rx_refill_timer); in xennet_disconnect_backend()
1820 if (queue->tx_irq && (queue->tx_irq == queue->rx_irq)) in xennet_disconnect_backend()
1821 unbind_from_irqhandler(queue->tx_irq, queue); in xennet_disconnect_backend()
1822 if (queue->tx_irq && (queue->tx_irq != queue->rx_irq)) { in xennet_disconnect_backend()
1823 unbind_from_irqhandler(queue->tx_irq, queue); in xennet_disconnect_backend()
1824 unbind_from_irqhandler(queue->rx_irq, queue); in xennet_disconnect_backend()
1826 queue->tx_evtchn = queue->rx_evtchn = 0; in xennet_disconnect_backend()
1827 queue->tx_irq = queue->rx_irq = 0; in xennet_disconnect_backend()
1829 if (netif_running(info->netdev)) in xennet_disconnect_backend()
1830 napi_synchronize(&queue->napi); in xennet_disconnect_backend()
1832 xennet_release_tx_bufs(queue); in xennet_disconnect_backend()
1833 xennet_release_rx_bufs(queue); in xennet_disconnect_backend()
1834 gnttab_free_grant_references(queue->gref_tx_head); in xennet_disconnect_backend()
1835 gnttab_free_grant_references(queue->gref_rx_head); in xennet_disconnect_backend()
1838 xennet_end_access(queue->tx_ring_ref, queue->tx.sring); in xennet_disconnect_backend()
1839 xennet_end_access(queue->rx_ring_ref, queue->rx.sring); in xennet_disconnect_backend()
1841 queue->tx_ring_ref = INVALID_GRANT_REF; in xennet_disconnect_backend()
1842 queue->rx_ring_ref = INVALID_GRANT_REF; in xennet_disconnect_backend()
1843 queue->tx.sring = NULL; in xennet_disconnect_backend()
1844 queue->rx.sring = NULL; in xennet_disconnect_backend()
1846 page_pool_destroy(queue->page_pool); in xennet_disconnect_backend()
1853 * leave the device-layer structures intact so that this is transparent to the
1858 struct netfront_info *info = dev_get_drvdata(&dev->dev); in netfront_resume()
1860 dev_dbg(&dev->dev, "%s\n", dev->nodename); in netfront_resume()
1862 netif_tx_lock_bh(info->netdev); in netfront_resume()
1863 netif_device_detach(info->netdev); in netfront_resume()
1864 netif_tx_unlock_bh(info->netdev); in netfront_resume()
1869 if (info->queues) in netfront_resume()
1881 macstr = s = xenbus_read(XBT_NIL, dev->nodename, "mac", NULL); in xen_net_read_mac()
1887 if ((s == e) || (*e != ((i == ETH_ALEN-1) ? '\0' : ':'))) { in xen_net_read_mac()
1889 return -ENOENT; in xen_net_read_mac()
1898 static int setup_netfront_single(struct netfront_queue *queue) in setup_netfront_single() argument
1902 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->tx_evtchn); in setup_netfront_single()
1906 err = bind_evtchn_to_irqhandler_lateeoi(queue->tx_evtchn, in setup_netfront_single()
1908 queue->info->netdev->name, in setup_netfront_single()
1909 queue); in setup_netfront_single()
1912 queue->rx_evtchn = queue->tx_evtchn; in setup_netfront_single()
1913 queue->rx_irq = queue->tx_irq = err; in setup_netfront_single()
1918 xenbus_free_evtchn(queue->info->xbdev, queue->tx_evtchn); in setup_netfront_single()
1919 queue->tx_evtchn = 0; in setup_netfront_single()
1924 static int setup_netfront_split(struct netfront_queue *queue) in setup_netfront_split() argument
1928 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->tx_evtchn); in setup_netfront_split()
1931 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->rx_evtchn); in setup_netfront_split()
1935 snprintf(queue->tx_irq_name, sizeof(queue->tx_irq_name), in setup_netfront_split()
1936 "%s-tx", queue->name); in setup_netfront_split()
1937 err = bind_evtchn_to_irqhandler_lateeoi(queue->tx_evtchn, in setup_netfront_split()
1939 queue->tx_irq_name, queue); in setup_netfront_split()
1942 queue->tx_irq = err; in setup_netfront_split()
1944 snprintf(queue->rx_irq_name, sizeof(queue->rx_irq_name), in setup_netfront_split()
1945 "%s-rx", queue->name); in setup_netfront_split()
1946 err = bind_evtchn_to_irqhandler_lateeoi(queue->rx_evtchn, in setup_netfront_split()
1948 queue->rx_irq_name, queue); in setup_netfront_split()
1951 queue->rx_irq = err; in setup_netfront_split()
1956 unbind_from_irqhandler(queue->tx_irq, queue); in setup_netfront_split()
1957 queue->tx_irq = 0; in setup_netfront_split()
1959 xenbus_free_evtchn(queue->info->xbdev, queue->rx_evtchn); in setup_netfront_split()
1960 queue->rx_evtchn = 0; in setup_netfront_split()
1962 xenbus_free_evtchn(queue->info->xbdev, queue->tx_evtchn); in setup_netfront_split()
1963 queue->tx_evtchn = 0; in setup_netfront_split()
1969 struct netfront_queue *queue, unsigned int feature_split_evtchn) in setup_netfront() argument
1975 queue->tx_ring_ref = INVALID_GRANT_REF; in setup_netfront()
1976 queue->rx_ring_ref = INVALID_GRANT_REF; in setup_netfront()
1977 queue->rx.sring = NULL; in setup_netfront()
1978 queue->tx.sring = NULL; in setup_netfront()
1981 1, &queue->tx_ring_ref); in setup_netfront()
1985 XEN_FRONT_RING_INIT(&queue->tx, txs, XEN_PAGE_SIZE); in setup_netfront()
1988 1, &queue->rx_ring_ref); in setup_netfront()
1992 XEN_FRONT_RING_INIT(&queue->rx, rxs, XEN_PAGE_SIZE); in setup_netfront()
1995 err = setup_netfront_split(queue); in setup_netfront()
1997 * a) feature-split-event-channels == 0 in setup_netfront()
1998 * b) feature-split-event-channels == 1 but failed to setup in setup_netfront()
2001 err = setup_netfront_single(queue); in setup_netfront()
2009 xenbus_teardown_ring((void **)&queue->rx.sring, 1, &queue->rx_ring_ref); in setup_netfront()
2010 xenbus_teardown_ring((void **)&queue->tx.sring, 1, &queue->tx_ring_ref); in setup_netfront()
2015 /* Queue-specific initialisation
2017 * be run per-queue.
2019 static int xennet_init_queue(struct netfront_queue *queue) in xennet_init_queue() argument
2025 spin_lock_init(&queue->tx_lock); in xennet_init_queue()
2026 spin_lock_init(&queue->rx_lock); in xennet_init_queue()
2027 spin_lock_init(&queue->rx_cons_lock); in xennet_init_queue()
2029 timer_setup(&queue->rx_refill_timer, rx_refill_timeout, 0); in xennet_init_queue()
2031 devid = strrchr(queue->info->xbdev->nodename, '/') + 1; in xennet_init_queue()
2032 snprintf(queue->name, sizeof(queue->name), "vif%s-q%u", in xennet_init_queue()
2033 devid, queue->id); in xennet_init_queue()
2036 queue->tx_skb_freelist = 0; in xennet_init_queue()
2037 queue->tx_pend_queue = TX_LINK_NONE; in xennet_init_queue()
2039 queue->tx_link[i] = i + 1; in xennet_init_queue()
2040 queue->grant_tx_ref[i] = INVALID_GRANT_REF; in xennet_init_queue()
2041 queue->grant_tx_page[i] = NULL; in xennet_init_queue()
2043 queue->tx_link[NET_TX_RING_SIZE - 1] = TX_LINK_NONE; in xennet_init_queue()
2047 queue->rx_skbs[i] = NULL; in xennet_init_queue()
2048 queue->grant_rx_ref[i] = INVALID_GRANT_REF; in xennet_init_queue()
2053 &queue->gref_tx_head) < 0) { in xennet_init_queue()
2055 err = -ENOMEM; in xennet_init_queue()
2059 /* A grant for every rx ring slot */ in xennet_init_queue()
2061 &queue->gref_rx_head) < 0) { in xennet_init_queue()
2062 pr_alert("can't alloc rx grant refs\n"); in xennet_init_queue()
2063 err = -ENOMEM; in xennet_init_queue()
2070 gnttab_free_grant_references(queue->gref_tx_head); in xennet_init_queue()
2075 static int write_queue_xenstore_keys(struct netfront_queue *queue, in write_queue_xenstore_keys() argument
2078 /* Write the queue-specific keys into XenStore in the traditional in write_queue_xenstore_keys()
2079 * way for a single queue, or in a queue subkeys for multiple in write_queue_xenstore_keys()
2082 struct xenbus_device *dev = queue->info->xbdev; in write_queue_xenstore_keys()
2090 pathsize = strlen(dev->nodename) + 10; in write_queue_xenstore_keys()
2093 err = -ENOMEM; in write_queue_xenstore_keys()
2097 snprintf(path, pathsize, "%s/queue-%u", in write_queue_xenstore_keys()
2098 dev->nodename, queue->id); in write_queue_xenstore_keys()
2100 path = (char *)dev->nodename; in write_queue_xenstore_keys()
2104 err = xenbus_printf(*xbt, path, "tx-ring-ref", "%u", in write_queue_xenstore_keys()
2105 queue->tx_ring_ref); in write_queue_xenstore_keys()
2107 message = "writing tx-ring-ref"; in write_queue_xenstore_keys()
2111 err = xenbus_printf(*xbt, path, "rx-ring-ref", "%u", in write_queue_xenstore_keys()
2112 queue->rx_ring_ref); in write_queue_xenstore_keys()
2114 message = "writing rx-ring-ref"; in write_queue_xenstore_keys()
2121 if (queue->tx_evtchn == queue->rx_evtchn) { in write_queue_xenstore_keys()
2124 "event-channel", "%u", queue->tx_evtchn); in write_queue_xenstore_keys()
2126 message = "writing event-channel"; in write_queue_xenstore_keys()
2132 "event-channel-tx", "%u", queue->tx_evtchn); in write_queue_xenstore_keys()
2134 message = "writing event-channel-tx"; in write_queue_xenstore_keys()
2139 "event-channel-rx", "%u", queue->rx_evtchn); in write_queue_xenstore_keys()
2141 message = "writing event-channel-rx"; in write_queue_xenstore_keys()
2159 static int xennet_create_page_pool(struct netfront_queue *queue) in xennet_create_page_pool() argument
2167 .dev = &queue->info->netdev->dev, in xennet_create_page_pool()
2169 .max_len = XEN_PAGE_SIZE - XDP_PACKET_HEADROOM, in xennet_create_page_pool()
2172 queue->page_pool = page_pool_create(&pp_params); in xennet_create_page_pool()
2173 if (IS_ERR(queue->page_pool)) { in xennet_create_page_pool()
2174 err = PTR_ERR(queue->page_pool); in xennet_create_page_pool()
2175 queue->page_pool = NULL; in xennet_create_page_pool()
2179 err = xdp_rxq_info_reg(&queue->xdp_rxq, queue->info->netdev, in xennet_create_page_pool()
2180 queue->id, 0); in xennet_create_page_pool()
2182 netdev_err(queue->info->netdev, "xdp_rxq_info_reg failed\n"); in xennet_create_page_pool()
2186 err = xdp_rxq_info_reg_mem_model(&queue->xdp_rxq, in xennet_create_page_pool()
2187 MEM_TYPE_PAGE_POOL, queue->page_pool); in xennet_create_page_pool()
2189 netdev_err(queue->info->netdev, "xdp_rxq_info_reg_mem_model failed\n"); in xennet_create_page_pool()
2195 xdp_rxq_info_unreg(&queue->xdp_rxq); in xennet_create_page_pool()
2197 page_pool_destroy(queue->page_pool); in xennet_create_page_pool()
2198 queue->page_pool = NULL; in xennet_create_page_pool()
2208 info->queues = kcalloc(*num_queues, sizeof(struct netfront_queue), in xennet_create_queues()
2210 if (!info->queues) in xennet_create_queues()
2211 return -ENOMEM; in xennet_create_queues()
2214 struct netfront_queue *queue = &info->queues[i]; in xennet_create_queues() local
2216 queue->id = i; in xennet_create_queues()
2217 queue->info = info; in xennet_create_queues()
2219 ret = xennet_init_queue(queue); in xennet_create_queues()
2221 dev_warn(&info->xbdev->dev, in xennet_create_queues()
2228 ret = xennet_create_page_pool(queue); in xennet_create_queues()
2230 dev_err(&info->xbdev->dev, "can't allocate page pool\n"); in xennet_create_queues()
2235 netif_napi_add(queue->info->netdev, &queue->napi, xennet_poll); in xennet_create_queues()
2236 if (netif_running(info->netdev)) in xennet_create_queues()
2237 napi_enable(&queue->napi); in xennet_create_queues()
2240 netif_set_real_num_tx_queues(info->netdev, *num_queues); in xennet_create_queues()
2243 dev_err(&info->xbdev->dev, "no queues\n"); in xennet_create_queues()
2244 return -EINVAL; in xennet_create_queues()
2259 struct netfront_queue *queue = NULL; in talk_to_netback() local
2263 info->netdev->irq = 0; in talk_to_netback()
2266 info->bounce = !xennet_trusted || in talk_to_netback()
2267 !xenbus_read_unsigned(dev->nodename, "trusted", 1); in talk_to_netback()
2270 max_queues = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2271 "multi-queue-max-queues", 1); in talk_to_netback()
2274 /* Check feature-split-event-channels */ in talk_to_netback()
2275 feature_split_evtchn = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2276 "feature-split-event-channels", 0); in talk_to_netback()
2281 xenbus_dev_fatal(dev, err, "parsing %s/mac", dev->nodename); in talk_to_netback()
2284 eth_hw_addr_set(info->netdev, addr); in talk_to_netback()
2286 info->netback_has_xdp_headroom = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2287 "feature-xdp-headroom", 0); in talk_to_netback()
2288 if (info->netback_has_xdp_headroom) { in talk_to_netback()
2289 /* set the current xen-netfront xdp state */ in talk_to_netback()
2290 err = talk_to_netback_xdp(info, info->netfront_xdp_enabled ? in talk_to_netback()
2298 if (info->queues) in talk_to_netback()
2302 info->broken = false; in talk_to_netback()
2307 kfree(info->queues); in talk_to_netback()
2308 info->queues = NULL; in talk_to_netback()
2313 /* Create shared ring, alloc event channel -- for each queue */ in talk_to_netback()
2315 queue = &info->queues[i]; in talk_to_netback()
2316 err = setup_netfront(dev, queue, feature_split_evtchn); in talk_to_netback()
2329 info->xbdev->otherend, "multi-queue-max-queues")) { in talk_to_netback()
2331 err = xenbus_printf(xbt, dev->nodename, in talk_to_netback()
2332 "multi-queue-num-queues", "%u", num_queues); in talk_to_netback()
2334 message = "writing multi-queue-num-queues"; in talk_to_netback()
2340 err = write_queue_xenstore_keys(&info->queues[0], &xbt, 0); /* flat */ in talk_to_netback()
2344 /* Write the keys for each queue */ in talk_to_netback()
2346 queue = &info->queues[i]; in talk_to_netback()
2347 err = write_queue_xenstore_keys(queue, &xbt, 1); /* hierarchical */ in talk_to_netback()
2353 /* The remaining keys are not queue-specific */ in talk_to_netback()
2354 err = xenbus_printf(xbt, dev->nodename, "request-rx-copy", "%u", in talk_to_netback()
2357 message = "writing request-rx-copy"; in talk_to_netback()
2361 err = xenbus_printf(xbt, dev->nodename, "feature-rx-notify", "%d", 1); in talk_to_netback()
2363 message = "writing feature-rx-notify"; in talk_to_netback()
2367 err = xenbus_printf(xbt, dev->nodename, "feature-sg", "%d", 1); in talk_to_netback()
2369 message = "writing feature-sg"; in talk_to_netback()
2373 err = xenbus_printf(xbt, dev->nodename, "feature-gso-tcpv4", "%d", 1); in talk_to_netback()
2375 message = "writing feature-gso-tcpv4"; in talk_to_netback()
2379 err = xenbus_write(xbt, dev->nodename, "feature-gso-tcpv6", "1"); in talk_to_netback()
2381 message = "writing feature-gso-tcpv6"; in talk_to_netback()
2385 err = xenbus_write(xbt, dev->nodename, "feature-ipv6-csum-offload", in talk_to_netback()
2388 message = "writing feature-ipv6-csum-offload"; in talk_to_netback()
2394 if (err == -EAGAIN) in talk_to_netback()
2413 device_unregister(&dev->dev); in talk_to_netback()
2423 struct netfront_queue *queue = NULL; in xennet_connect() local
2425 if (!xenbus_read_unsigned(np->xbdev->otherend, "feature-rx-copy", 0)) { in xennet_connect()
2426 dev_info(&dev->dev, in xennet_connect()
2428 return -ENODEV; in xennet_connect()
2431 err = talk_to_netback(np->xbdev, np); in xennet_connect()
2434 if (np->netback_has_xdp_headroom) in xennet_connect()
2436 if (np->bounce) in xennet_connect()
2437 dev_info(&np->xbdev->dev, in xennet_connect()
2441 num_queues = dev->real_num_tx_queues; in xennet_connect()
2443 if (dev->reg_state == NETREG_UNINITIALIZED) { in xennet_connect()
2447 device_unregister(&np->xbdev->dev); in xennet_connect()
2462 netif_tx_lock_bh(np->netdev); in xennet_connect()
2463 netif_device_attach(np->netdev); in xennet_connect()
2464 netif_tx_unlock_bh(np->netdev); in xennet_connect()
2466 netif_carrier_on(np->netdev); in xennet_connect()
2468 queue = &np->queues[j]; in xennet_connect()
2470 notify_remote_via_irq(queue->tx_irq); in xennet_connect()
2471 if (queue->tx_irq != queue->rx_irq) in xennet_connect()
2472 notify_remote_via_irq(queue->rx_irq); in xennet_connect()
2474 spin_lock_bh(&queue->rx_lock); in xennet_connect()
2475 xennet_alloc_rx_buffers(queue); in xennet_connect()
2476 spin_unlock_bh(&queue->rx_lock); in xennet_connect()
2488 struct netfront_info *np = dev_get_drvdata(&dev->dev); in netback_changed()
2489 struct net_device *netdev = np->netdev; in netback_changed()
2491 dev_dbg(&dev->dev, "%s\n", xenbus_strstate(backend_state)); in netback_changed()
2504 if (dev->state != XenbusStateInitialising) in netback_changed()
2516 if (dev->state == XenbusStateClosed) in netback_changed()
2541 return -EINVAL; in xennet_get_sset_count()
2592 return -EPERM; in store_rxbuf()
2596 return -EBADMSG; in store_rxbuf()
2623 if (xenbus_read_driver_state(dev->otherend) == XenbusStateClosed) in xennet_bus_close()
2628 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2630 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2632 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2637 if (xenbus_read_driver_state(dev->otherend) == XenbusStateClosed) in xennet_bus_close()
2643 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2645 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2653 struct netfront_info *info = dev_get_drvdata(&dev->dev); in xennet_remove()
2658 if (info->netdev->reg_state == NETREG_REGISTERED) in xennet_remove()
2659 unregister_netdev(info->netdev); in xennet_remove()
2661 if (info->queues) { in xennet_remove()
2666 xennet_free_netdev(info->netdev); in xennet_remove()
2685 return -ENODEV; in netif_init()
2688 return -ENODEV; in netif_init()