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))
90 /* Minimum number of Rx slots (includes slot for GSO metadata). */
93 /* Queue name is interface name with "-qNNN" appended */
96 /* IRQ name is queue name with "-tx" or "-rx" appended */
110 unsigned int id; /* Queue ID, 0-based */
111 char name[QUEUE_NAME_SIZE]; /* DEVNAME-qN */
124 char tx_irq_name[IRQ_NAME_SIZE]; /* DEVNAME-qN-tx */
125 char rx_irq_name[IRQ_NAME_SIZE]; /* DEVNAME-qN-rx */
132 * {tx,rx}_skbs store outstanding skbuffs. Free tx_skb entries
146 struct xen_netif_rx_front_ring rx; member
168 /* Multi-queue support */
189 struct xen_netif_rx_response rx; member
190 struct xen_netif_extra_info extras[XEN_NETIF_EXTRA_TYPE_MAX - 1];
217 return idx & (NET_RX_RING_SIZE - 1); in xennet_rxidx()
220 static struct sk_buff *xennet_get_rx_skb(struct netfront_queue *queue, in xennet_get_rx_skb() argument
224 struct sk_buff *skb = queue->rx_skbs[i]; in xennet_get_rx_skb()
225 queue->rx_skbs[i] = NULL; in xennet_get_rx_skb()
229 static grant_ref_t xennet_get_rx_ref(struct netfront_queue *queue, in xennet_get_rx_ref() argument
233 grant_ref_t ref = queue->grant_rx_ref[i]; in xennet_get_rx_ref()
234 queue->grant_rx_ref[i] = GRANT_INVALID_REF; in xennet_get_rx_ref()
244 return dev->features & NETIF_F_SG; in xennet_can_sg()
250 struct netfront_queue *queue = from_timer(queue, t, rx_refill_timer); in rx_refill_timeout() local
251 napi_schedule(&queue->napi); in rx_refill_timeout()
254 static int netfront_tx_slot_available(struct netfront_queue *queue) in netfront_tx_slot_available() argument
256 return (queue->tx.req_prod_pvt - queue->tx.rsp_cons) < in netfront_tx_slot_available()
257 (NET_TX_RING_SIZE - XEN_NETIF_NR_SLOTS_MIN - 1); in netfront_tx_slot_available()
260 static void xennet_maybe_wake_tx(struct netfront_queue *queue) in xennet_maybe_wake_tx() argument
262 struct net_device *dev = queue->info->netdev; in xennet_maybe_wake_tx()
263 struct netdev_queue *dev_queue = netdev_get_tx_queue(dev, queue->id); in xennet_maybe_wake_tx()
266 netfront_tx_slot_available(queue) && in xennet_maybe_wake_tx()
268 netif_tx_wake_queue(netdev_get_tx_queue(dev, queue->id)); in xennet_maybe_wake_tx()
272 static struct sk_buff *xennet_alloc_one_rx_buffer(struct netfront_queue *queue) in xennet_alloc_one_rx_buffer() argument
277 skb = __netdev_alloc_skb(queue->info->netdev, in xennet_alloc_one_rx_buffer()
283 page = page_pool_alloc_pages(queue->page_pool, in xennet_alloc_one_rx_buffer()
293 skb->dev = queue->info->netdev; in xennet_alloc_one_rx_buffer()
299 static void xennet_alloc_rx_buffers(struct netfront_queue *queue) in xennet_alloc_rx_buffers() argument
301 RING_IDX req_prod = queue->rx.req_prod_pvt; in xennet_alloc_rx_buffers()
305 if (unlikely(!netif_carrier_ok(queue->info->netdev))) in xennet_alloc_rx_buffers()
308 for (req_prod = queue->rx.req_prod_pvt; in xennet_alloc_rx_buffers()
309 req_prod - queue->rx.rsp_cons < NET_RX_RING_SIZE; in xennet_alloc_rx_buffers()
317 skb = xennet_alloc_one_rx_buffer(queue); in xennet_alloc_rx_buffers()
319 err = -ENOMEM; in xennet_alloc_rx_buffers()
325 BUG_ON(queue->rx_skbs[id]); in xennet_alloc_rx_buffers()
326 queue->rx_skbs[id] = skb; in xennet_alloc_rx_buffers()
328 ref = gnttab_claim_grant_reference(&queue->gref_rx_head); in xennet_alloc_rx_buffers()
330 queue->grant_rx_ref[id] = ref; in xennet_alloc_rx_buffers()
332 page = skb_frag_page(&skb_shinfo(skb)->frags[0]); in xennet_alloc_rx_buffers()
334 req = RING_GET_REQUEST(&queue->rx, req_prod); in xennet_alloc_rx_buffers()
336 queue->info->xbdev->otherend_id, in xennet_alloc_rx_buffers()
339 req->id = id; in xennet_alloc_rx_buffers()
340 req->gref = ref; in xennet_alloc_rx_buffers()
343 queue->rx.req_prod_pvt = req_prod; in xennet_alloc_rx_buffers()
350 if (req_prod - queue->rx.rsp_cons < NET_RX_SLOTS_MIN || in xennet_alloc_rx_buffers()
352 mod_timer(&queue->rx_refill_timer, jiffies + (HZ/10)); in xennet_alloc_rx_buffers()
356 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->rx, notify); in xennet_alloc_rx_buffers()
358 notify_remote_via_irq(queue->rx_irq); in xennet_alloc_rx_buffers()
364 unsigned int num_queues = dev->real_num_tx_queues; in xennet_open()
366 struct netfront_queue *queue = NULL; in xennet_open() local
368 if (!np->queues || np->broken) in xennet_open()
369 return -ENODEV; in xennet_open()
372 queue = &np->queues[i]; in xennet_open()
373 napi_enable(&queue->napi); in xennet_open()
375 spin_lock_bh(&queue->rx_lock); in xennet_open()
377 xennet_alloc_rx_buffers(queue); in xennet_open()
378 queue->rx.sring->rsp_event = queue->rx.rsp_cons + 1; in xennet_open()
379 if (RING_HAS_UNCONSUMED_RESPONSES(&queue->rx)) in xennet_open()
380 napi_schedule(&queue->napi); in xennet_open()
382 spin_unlock_bh(&queue->rx_lock); in xennet_open()
390 static bool xennet_tx_buf_gc(struct netfront_queue *queue) in xennet_tx_buf_gc() argument
397 const struct device *dev = &queue->info->netdev->dev; in xennet_tx_buf_gc()
399 BUG_ON(!netif_carrier_ok(queue->info->netdev)); in xennet_tx_buf_gc()
402 prod = queue->tx.sring->rsp_prod; in xennet_tx_buf_gc()
403 if (RING_RESPONSE_PROD_OVERFLOW(&queue->tx, prod)) { in xennet_tx_buf_gc()
405 prod - queue->tx.rsp_cons); in xennet_tx_buf_gc()
410 for (cons = queue->tx.rsp_cons; cons != prod; cons++) { in xennet_tx_buf_gc()
415 RING_COPY_RESPONSE(&queue->tx, cons, &txrsp); in xennet_tx_buf_gc()
420 if (id >= RING_SIZE(&queue->tx)) { in xennet_tx_buf_gc()
426 if (queue->tx_link[id] != TX_PENDING) { in xennet_tx_buf_gc()
432 queue->tx_link[id] = TX_LINK_NONE; in xennet_tx_buf_gc()
433 skb = queue->tx_skbs[id]; in xennet_tx_buf_gc()
434 queue->tx_skbs[id] = NULL; in xennet_tx_buf_gc()
436 queue->grant_tx_ref[id], GNTMAP_readonly))) { in xennet_tx_buf_gc()
442 &queue->gref_tx_head, queue->grant_tx_ref[id]); in xennet_tx_buf_gc()
443 queue->grant_tx_ref[id] = GRANT_INVALID_REF; in xennet_tx_buf_gc()
444 queue->grant_tx_page[id] = NULL; in xennet_tx_buf_gc()
445 add_id_to_list(&queue->tx_skb_freelist, queue->tx_link, id); in xennet_tx_buf_gc()
449 queue->tx.rsp_cons = prod; in xennet_tx_buf_gc()
451 RING_FINAL_CHECK_FOR_RESPONSES(&queue->tx, more_to_do); in xennet_tx_buf_gc()
454 xennet_maybe_wake_tx(queue); in xennet_tx_buf_gc()
459 queue->info->broken = true; in xennet_tx_buf_gc()
466 struct netfront_queue *queue; member
482 struct page *page = info->page; in xennet_tx_setup_grant()
483 struct netfront_queue *queue = info->queue; in xennet_tx_setup_grant() local
484 struct sk_buff *skb = info->skb; in xennet_tx_setup_grant()
486 id = get_id_from_list(&queue->tx_skb_freelist, queue->tx_link); in xennet_tx_setup_grant()
487 tx = RING_GET_REQUEST(&queue->tx, queue->tx.req_prod_pvt++); in xennet_tx_setup_grant()
488 ref = gnttab_claim_grant_reference(&queue->gref_tx_head); in xennet_tx_setup_grant()
491 gnttab_grant_foreign_access_ref(ref, queue->info->xbdev->otherend_id, in xennet_tx_setup_grant()
494 queue->tx_skbs[id] = skb; in xennet_tx_setup_grant()
495 queue->grant_tx_page[id] = page; in xennet_tx_setup_grant()
496 queue->grant_tx_ref[id] = ref; in xennet_tx_setup_grant()
498 info->tx_local.id = id; in xennet_tx_setup_grant()
499 info->tx_local.gref = ref; in xennet_tx_setup_grant()
500 info->tx_local.offset = offset; in xennet_tx_setup_grant()
501 info->tx_local.size = len; in xennet_tx_setup_grant()
502 info->tx_local.flags = 0; in xennet_tx_setup_grant()
504 *tx = info->tx_local; in xennet_tx_setup_grant()
507 * Put the request in the pending queue, it will be set to be pending in xennet_tx_setup_grant()
510 add_id_to_list(&queue->tx_pend_queue, queue->tx_link, id); in xennet_tx_setup_grant()
512 info->tx = tx; in xennet_tx_setup_grant()
513 info->size += info->tx_local.size; in xennet_tx_setup_grant()
520 info->size = 0; in xennet_make_first_txreq()
522 gnttab_for_one_grant(info->page, offset, len, xennet_tx_setup_grant, info); in xennet_make_first_txreq()
524 return info->tx; in xennet_make_first_txreq()
532 info->tx->flags |= XEN_NETTXF_more_data; in xennet_make_one_txreq()
533 skb_get(info->skb); in xennet_make_one_txreq()
547 info->page = page; in xennet_make_txreqs()
548 info->size = 0; in xennet_make_txreqs()
556 len -= info->size; in xennet_make_txreqs()
566 int i, frags = skb_shinfo(skb)->nr_frags; in xennet_count_skb_slots()
569 slots = gnttab_count_grant(offset_in_page(skb->data), in xennet_count_skb_slots()
573 skb_frag_t *frag = skb_shinfo(skb)->frags + i; in xennet_count_skb_slots()
589 unsigned int num_queues = dev->real_num_tx_queues; in xennet_select_queue()
593 /* First, check if there is only one queue */ in xennet_select_queue()
604 static void xennet_mark_tx_pending(struct netfront_queue *queue) in xennet_mark_tx_pending() argument
608 while ((i = get_id_from_list(&queue->tx_pend_queue, queue->tx_link)) != in xennet_mark_tx_pending()
610 queue->tx_link[i] = TX_PENDING; in xennet_mark_tx_pending()
614 struct netfront_queue *queue, in xennet_xdp_xmit_one() argument
618 struct netfront_stats *tx_stats = this_cpu_ptr(np->tx_stats); in xennet_xdp_xmit_one()
620 .queue = queue, in xennet_xdp_xmit_one()
622 .page = virt_to_page(xdpf->data), in xennet_xdp_xmit_one()
627 offset_in_page(xdpf->data), in xennet_xdp_xmit_one()
628 xdpf->len); in xennet_xdp_xmit_one()
630 xennet_mark_tx_pending(queue); in xennet_xdp_xmit_one()
632 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->tx, notify); in xennet_xdp_xmit_one()
634 notify_remote_via_irq(queue->tx_irq); in xennet_xdp_xmit_one()
636 u64_stats_update_begin(&tx_stats->syncp); in xennet_xdp_xmit_one()
637 tx_stats->bytes += xdpf->len; in xennet_xdp_xmit_one()
638 tx_stats->packets++; in xennet_xdp_xmit_one()
639 u64_stats_update_end(&tx_stats->syncp); in xennet_xdp_xmit_one()
641 xennet_tx_buf_gc(queue); in xennet_xdp_xmit_one()
649 unsigned int num_queues = dev->real_num_tx_queues; in xennet_xdp_xmit()
651 struct netfront_queue *queue = NULL; in xennet_xdp_xmit() local
656 if (unlikely(np->broken)) in xennet_xdp_xmit()
657 return -ENODEV; in xennet_xdp_xmit()
659 return -EINVAL; in xennet_xdp_xmit()
661 queue = &np->queues[smp_processor_id() % num_queues]; in xennet_xdp_xmit()
663 spin_lock_irqsave(&queue->tx_lock, irq_flags); in xennet_xdp_xmit()
669 err = xennet_xdp_xmit_one(dev, queue, xdpf); in xennet_xdp_xmit()
675 spin_unlock_irqrestore(&queue->tx_lock, irq_flags); in xennet_xdp_xmit()
677 return n - drops; in xennet_xdp_xmit()
684 unsigned int size = ALIGN(skb_end_offset(skb) + skb->data_len, in bounce_skb()
691 if (!IS_ALIGNED((uintptr_t)n->head, XEN_PAGE_SIZE)) { in bounce_skb()
700 skb_put(n, skb->len); in bounce_skb()
702 BUG_ON(skb_copy_bits(skb, -headerlen, n->head, headerlen + skb->len)); in bounce_skb()
713 struct netfront_stats *tx_stats = this_cpu_ptr(np->tx_stats); in xennet_start_xmit()
722 struct netfront_queue *queue = NULL; in xennet_start_xmit() local
724 unsigned int num_queues = dev->real_num_tx_queues; in xennet_start_xmit()
731 if (unlikely(np->broken)) in xennet_start_xmit()
733 /* Determine which queue to transmit this SKB on */ in xennet_start_xmit()
735 queue = &np->queues[queue_index]; in xennet_start_xmit()
737 /* If skb->len is too big for wire format, drop skb and alert in xennet_start_xmit()
740 if (unlikely(skb->len > XEN_NETIF_MAX_TX_SIZE)) { in xennet_start_xmit()
742 "xennet: skb->len = %u, too big for wire format\n", in xennet_start_xmit()
743 skb->len); in xennet_start_xmit()
750 slots, skb->len); in xennet_start_xmit()
755 page = virt_to_page(skb->data); in xennet_start_xmit()
756 offset = offset_in_page(skb->data); in xennet_start_xmit()
765 if (np->bounce || unlikely(PAGE_SIZE - offset < ETH_HLEN)) { in xennet_start_xmit()
771 page = virt_to_page(skb->data); in xennet_start_xmit()
772 offset = offset_in_page(skb->data); in xennet_start_xmit()
777 spin_lock_irqsave(&queue->tx_lock, flags); in xennet_start_xmit()
782 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_start_xmit()
787 info.queue = queue; in xennet_start_xmit()
796 len -= info.tx_local.size; in xennet_start_xmit()
798 if (skb->ip_summed == CHECKSUM_PARTIAL) in xennet_start_xmit()
800 first_tx->flags |= XEN_NETTXF_csum_blank | in xennet_start_xmit()
802 else if (skb->ip_summed == CHECKSUM_UNNECESSARY) in xennet_start_xmit()
804 first_tx->flags |= XEN_NETTXF_data_validated; in xennet_start_xmit()
807 if (skb_shinfo(skb)->gso_size) { in xennet_start_xmit()
811 RING_GET_REQUEST(&queue->tx, queue->tx.req_prod_pvt++); in xennet_start_xmit()
813 first_tx->flags |= XEN_NETTXF_extra_info; in xennet_start_xmit()
815 gso->u.gso.size = skb_shinfo(skb)->gso_size; in xennet_start_xmit()
816 gso->u.gso.type = (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV6) ? in xennet_start_xmit()
819 gso->u.gso.pad = 0; in xennet_start_xmit()
820 gso->u.gso.features = 0; in xennet_start_xmit()
822 gso->type = XEN_NETIF_EXTRA_TYPE_GSO; in xennet_start_xmit()
823 gso->flags = 0; in xennet_start_xmit()
830 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { in xennet_start_xmit()
831 skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; in xennet_start_xmit()
838 first_tx->size = skb->len; in xennet_start_xmit()
843 xennet_mark_tx_pending(queue); in xennet_start_xmit()
845 RING_PUSH_REQUESTS_AND_CHECK_NOTIFY(&queue->tx, notify); in xennet_start_xmit()
847 notify_remote_via_irq(queue->tx_irq); in xennet_start_xmit()
849 u64_stats_update_begin(&tx_stats->syncp); in xennet_start_xmit()
850 tx_stats->bytes += skb->len; in xennet_start_xmit()
851 tx_stats->packets++; in xennet_start_xmit()
852 u64_stats_update_end(&tx_stats->syncp); in xennet_start_xmit()
855 xennet_tx_buf_gc(queue); in xennet_start_xmit()
857 if (!netfront_tx_slot_available(queue)) in xennet_start_xmit()
858 netif_tx_stop_queue(netdev_get_tx_queue(dev, queue->id)); in xennet_start_xmit()
860 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_start_xmit()
865 dev->stats.tx_dropped++; in xennet_start_xmit()
873 unsigned int num_queues = dev->real_num_tx_queues; in xennet_close()
875 struct netfront_queue *queue; in xennet_close() local
876 netif_tx_stop_all_queues(np->netdev); in xennet_close()
878 queue = &np->queues[i]; in xennet_close()
879 napi_disable(&queue->napi); in xennet_close()
888 for (i = 0; i < info->netdev->real_num_tx_queues; i++) { in xennet_destroy_queues()
889 struct netfront_queue *queue = &info->queues[i]; in xennet_destroy_queues() local
891 if (netif_running(info->netdev)) in xennet_destroy_queues()
892 napi_disable(&queue->napi); in xennet_destroy_queues()
893 netif_napi_del(&queue->napi); in xennet_destroy_queues()
896 kfree(info->queues); in xennet_destroy_queues()
897 info->queues = NULL; in xennet_destroy_queues()
906 static void xennet_set_rx_rsp_cons(struct netfront_queue *queue, RING_IDX val) in xennet_set_rx_rsp_cons() argument
910 spin_lock_irqsave(&queue->rx_cons_lock, flags); in xennet_set_rx_rsp_cons()
911 queue->rx.rsp_cons = val; in xennet_set_rx_rsp_cons()
912 queue->rx_rsp_unconsumed = RING_HAS_UNCONSUMED_RESPONSES(&queue->rx); in xennet_set_rx_rsp_cons()
913 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_set_rx_rsp_cons()
916 static void xennet_move_rx_slot(struct netfront_queue *queue, struct sk_buff *skb, in xennet_move_rx_slot() argument
919 int new = xennet_rxidx(queue->rx.req_prod_pvt); in xennet_move_rx_slot()
921 BUG_ON(queue->rx_skbs[new]); in xennet_move_rx_slot()
922 queue->rx_skbs[new] = skb; in xennet_move_rx_slot()
923 queue->grant_rx_ref[new] = ref; in xennet_move_rx_slot()
924 RING_GET_REQUEST(&queue->rx, queue->rx.req_prod_pvt)->id = new; in xennet_move_rx_slot()
925 RING_GET_REQUEST(&queue->rx, queue->rx.req_prod_pvt)->gref = ref; in xennet_move_rx_slot()
926 queue->rx.req_prod_pvt++; in xennet_move_rx_slot()
929 static int xennet_get_extras(struct netfront_queue *queue, in xennet_get_extras() argument
935 struct device *dev = &queue->info->netdev->dev; in xennet_get_extras()
936 RING_IDX cons = queue->rx.rsp_cons; in xennet_get_extras()
946 err = -EBADR; in xennet_get_extras()
950 RING_COPY_RESPONSE(&queue->rx, ++cons, &extra); in xennet_get_extras()
957 err = -EINVAL; in xennet_get_extras()
959 extras[extra.type - 1] = extra; in xennet_get_extras()
962 skb = xennet_get_rx_skb(queue, cons); in xennet_get_extras()
963 ref = xennet_get_rx_ref(queue, cons); in xennet_get_extras()
964 xennet_move_rx_slot(queue, skb, ref); in xennet_get_extras()
967 xennet_set_rx_rsp_cons(queue, cons); in xennet_get_extras()
971 static u32 xennet_run_xdp(struct netfront_queue *queue, struct page *pdata, in xennet_run_xdp() argument
972 struct xen_netif_rx_response *rx, struct bpf_prog *prog, in xennet_run_xdp() argument
976 u32 len = rx->status; in xennet_run_xdp()
980 xdp->data_hard_start = page_address(pdata); in xennet_run_xdp()
981 xdp->data = xdp->data_hard_start + XDP_PACKET_HEADROOM; in xennet_run_xdp()
983 xdp->data_end = xdp->data + len; in xennet_run_xdp()
984 xdp->rxq = &queue->xdp_rxq; in xennet_run_xdp()
985 xdp->frame_sz = XEN_PAGE_SIZE - XDP_PACKET_HEADROOM; in xennet_run_xdp()
992 err = xennet_xdp_xmit(queue->info->netdev, 1, &xdpf, 0); in xennet_run_xdp()
994 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
998 err = xdp_do_redirect(queue->info->netdev, xdp, prog); in xennet_run_xdp()
1001 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
1008 trace_xdp_exception(queue->info->netdev, prog, act); in xennet_run_xdp()
1018 static int xennet_get_responses(struct netfront_queue *queue, in xennet_get_responses() argument
1023 struct xen_netif_rx_response *rx = &rinfo->rx, rx_local; in xennet_get_responses() local
1024 int max = XEN_NETIF_NR_SLOTS_MIN + (rx->status <= RX_COPY_THRESHOLD); in xennet_get_responses()
1025 RING_IDX cons = queue->rx.rsp_cons; in xennet_get_responses()
1026 struct sk_buff *skb = xennet_get_rx_skb(queue, cons); in xennet_get_responses()
1027 struct xen_netif_extra_info *extras = rinfo->extras; in xennet_get_responses()
1028 grant_ref_t ref = xennet_get_rx_ref(queue, cons); in xennet_get_responses()
1029 struct device *dev = &queue->info->netdev->dev; in xennet_get_responses()
1036 if (rx->flags & XEN_NETRXF_extra_info) { in xennet_get_responses()
1037 err = xennet_get_extras(queue, extras, rp); in xennet_get_responses()
1039 if (extras[XEN_NETIF_EXTRA_TYPE_XDP - 1].type) { in xennet_get_responses()
1042 xdp = &extras[XEN_NETIF_EXTRA_TYPE_XDP - 1]; in xennet_get_responses()
1043 rx->offset = xdp->u.xdp.headroom; in xennet_get_responses()
1046 cons = queue->rx.rsp_cons; in xennet_get_responses()
1050 if (unlikely(rx->status < 0 || in xennet_get_responses()
1051 rx->offset + rx->status > XEN_PAGE_SIZE)) { in xennet_get_responses()
1053 dev_warn(dev, "rx->offset: %u, size: %d\n", in xennet_get_responses()
1054 rx->offset, rx->status); in xennet_get_responses()
1055 xennet_move_rx_slot(queue, skb, ref); in xennet_get_responses()
1056 err = -EINVAL; in xennet_get_responses()
1067 dev_warn(dev, "Bad rx response id %d.\n", in xennet_get_responses()
1068 rx->id); in xennet_get_responses()
1069 err = -EINVAL; in xennet_get_responses()
1076 queue->info->broken = true; in xennet_get_responses()
1078 return -EINVAL; in xennet_get_responses()
1081 gnttab_release_grant_reference(&queue->gref_rx_head, ref); in xennet_get_responses()
1084 xdp_prog = rcu_dereference(queue->xdp_prog); in xennet_get_responses()
1086 if (!(rx->flags & XEN_NETRXF_more_data)) { in xennet_get_responses()
1088 verdict = xennet_run_xdp(queue, in xennet_get_responses()
1089 skb_frag_page(&skb_shinfo(skb)->frags[0]), in xennet_get_responses()
1090 rx, xdp_prog, &xdp, need_xdp_flush); in xennet_get_responses()
1092 err = -EINVAL; in xennet_get_responses()
1095 err = -EINVAL; in xennet_get_responses()
1103 if (!(rx->flags & XEN_NETRXF_more_data)) in xennet_get_responses()
1109 err = -ENOENT; in xennet_get_responses()
1113 RING_COPY_RESPONSE(&queue->rx, cons + slots, &rx_local); in xennet_get_responses()
1114 rx = &rx_local; in xennet_get_responses()
1115 skb = xennet_get_rx_skb(queue, cons + slots); in xennet_get_responses()
1116 ref = xennet_get_rx_ref(queue, cons + slots); in xennet_get_responses()
1123 err = -E2BIG; in xennet_get_responses()
1127 xennet_set_rx_rsp_cons(queue, cons + slots); in xennet_get_responses()
1135 if (!gso->u.gso.size) { in xennet_set_skb_gso()
1138 return -EINVAL; in xennet_set_skb_gso()
1141 if (gso->u.gso.type != XEN_NETIF_GSO_TYPE_TCPV4 && in xennet_set_skb_gso()
1142 gso->u.gso.type != XEN_NETIF_GSO_TYPE_TCPV6) { in xennet_set_skb_gso()
1144 pr_warn("Bad GSO type %d\n", gso->u.gso.type); in xennet_set_skb_gso()
1145 return -EINVAL; in xennet_set_skb_gso()
1148 skb_shinfo(skb)->gso_size = gso->u.gso.size; in xennet_set_skb_gso()
1149 skb_shinfo(skb)->gso_type = in xennet_set_skb_gso()
1150 (gso->u.gso.type == XEN_NETIF_GSO_TYPE_TCPV4) ? in xennet_set_skb_gso()
1155 skb_shinfo(skb)->gso_type |= SKB_GSO_DODGY; in xennet_set_skb_gso()
1156 skb_shinfo(skb)->gso_segs = 0; in xennet_set_skb_gso()
1161 static int xennet_fill_frags(struct netfront_queue *queue, in xennet_fill_frags() argument
1165 RING_IDX cons = queue->rx.rsp_cons; in xennet_fill_frags()
1169 struct xen_netif_rx_response rx; in xennet_fill_frags() local
1170 skb_frag_t *nfrag = &skb_shinfo(nskb)->frags[0]; in xennet_fill_frags()
1172 RING_COPY_RESPONSE(&queue->rx, ++cons, &rx); in xennet_fill_frags()
1174 if (skb_shinfo(skb)->nr_frags == MAX_SKB_FRAGS) { in xennet_fill_frags()
1175 unsigned int pull_to = NETFRONT_SKB_CB(skb)->pull_to; in xennet_fill_frags()
1178 __pskb_pull_tail(skb, pull_to - skb_headlen(skb)); in xennet_fill_frags()
1180 if (unlikely(skb_shinfo(skb)->nr_frags >= MAX_SKB_FRAGS)) { in xennet_fill_frags()
1181 xennet_set_rx_rsp_cons(queue, in xennet_fill_frags()
1184 return -ENOENT; in xennet_fill_frags()
1187 skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, in xennet_fill_frags()
1189 rx.offset, rx.status, PAGE_SIZE); in xennet_fill_frags()
1191 skb_shinfo(nskb)->nr_frags = 0; in xennet_fill_frags()
1195 xennet_set_rx_rsp_cons(queue, cons); in xennet_fill_frags()
1210 if (skb->ip_summed != CHECKSUM_PARTIAL && skb_is_gso(skb)) { in checksum_setup()
1212 atomic_inc(&np->rx_gso_checksum_fixup); in checksum_setup()
1213 skb->ip_summed = CHECKSUM_PARTIAL; in checksum_setup()
1217 /* A non-CHECKSUM_PARTIAL SKB does not require setup. */ in checksum_setup()
1218 if (skb->ip_summed != CHECKSUM_PARTIAL) in checksum_setup()
1224 static int handle_incoming_queue(struct netfront_queue *queue, in handle_incoming_queue() argument
1227 struct netfront_stats *rx_stats = this_cpu_ptr(queue->info->rx_stats); in handle_incoming_queue()
1232 int pull_to = NETFRONT_SKB_CB(skb)->pull_to; in handle_incoming_queue()
1235 __pskb_pull_tail(skb, pull_to - skb_headlen(skb)); in handle_incoming_queue()
1238 skb->protocol = eth_type_trans(skb, queue->info->netdev); in handle_incoming_queue()
1241 if (checksum_setup(queue->info->netdev, skb)) { in handle_incoming_queue()
1244 queue->info->netdev->stats.rx_errors++; in handle_incoming_queue()
1248 u64_stats_update_begin(&rx_stats->syncp); in handle_incoming_queue()
1249 rx_stats->packets++; in handle_incoming_queue()
1250 rx_stats->bytes += skb->len; in handle_incoming_queue()
1251 u64_stats_update_end(&rx_stats->syncp); in handle_incoming_queue()
1254 napi_gro_receive(&queue->napi, skb); in handle_incoming_queue()
1262 struct netfront_queue *queue = container_of(napi, struct netfront_queue, napi); in xennet_poll() local
1263 struct net_device *dev = queue->info->netdev; in xennet_poll()
1266 struct xen_netif_rx_response *rx = &rinfo.rx; in xennet_poll() local
1276 spin_lock(&queue->rx_lock); in xennet_poll()
1282 rp = queue->rx.sring->rsp_prod; in xennet_poll()
1283 if (RING_RESPONSE_PROD_OVERFLOW(&queue->rx, rp)) { in xennet_poll()
1284 dev_alert(&dev->dev, "Illegal number of responses %u\n", in xennet_poll()
1285 rp - queue->rx.rsp_cons); in xennet_poll()
1286 queue->info->broken = true; in xennet_poll()
1287 spin_unlock(&queue->rx_lock); in xennet_poll()
1292 i = queue->rx.rsp_cons; in xennet_poll()
1295 RING_COPY_RESPONSE(&queue->rx, i, rx); in xennet_poll()
1298 err = xennet_get_responses(queue, &rinfo, rp, &tmpq, in xennet_poll()
1302 if (queue->info->broken) { in xennet_poll()
1303 spin_unlock(&queue->rx_lock); in xennet_poll()
1309 dev->stats.rx_errors++; in xennet_poll()
1310 i = queue->rx.rsp_cons; in xennet_poll()
1316 if (extras[XEN_NETIF_EXTRA_TYPE_GSO - 1].type) { in xennet_poll()
1318 gso = &extras[XEN_NETIF_EXTRA_TYPE_GSO - 1]; in xennet_poll()
1322 xennet_set_rx_rsp_cons(queue, in xennet_poll()
1323 queue->rx.rsp_cons + in xennet_poll()
1329 NETFRONT_SKB_CB(skb)->pull_to = rx->status; in xennet_poll()
1330 if (NETFRONT_SKB_CB(skb)->pull_to > RX_COPY_THRESHOLD) in xennet_poll()
1331 NETFRONT_SKB_CB(skb)->pull_to = RX_COPY_THRESHOLD; in xennet_poll()
1333 skb_frag_off_set(&skb_shinfo(skb)->frags[0], rx->offset); in xennet_poll()
1334 skb_frag_size_set(&skb_shinfo(skb)->frags[0], rx->status); in xennet_poll()
1335 skb->data_len = rx->status; in xennet_poll()
1336 skb->len += rx->status; in xennet_poll()
1338 if (unlikely(xennet_fill_frags(queue, skb, &tmpq))) in xennet_poll()
1341 if (rx->flags & XEN_NETRXF_csum_blank) in xennet_poll()
1342 skb->ip_summed = CHECKSUM_PARTIAL; in xennet_poll()
1343 else if (rx->flags & XEN_NETRXF_data_validated) in xennet_poll()
1344 skb->ip_summed = CHECKSUM_UNNECESSARY; in xennet_poll()
1348 i = queue->rx.rsp_cons + 1; in xennet_poll()
1349 xennet_set_rx_rsp_cons(queue, i); in xennet_poll()
1357 work_done -= handle_incoming_queue(queue, &rxq); in xennet_poll()
1359 xennet_alloc_rx_buffers(queue); in xennet_poll()
1366 RING_FINAL_CHECK_FOR_RESPONSES(&queue->rx, more_to_do); in xennet_poll()
1371 spin_unlock(&queue->rx_lock); in xennet_poll()
1381 return -EINVAL; in xennet_change_mtu()
1382 dev->mtu = mtu; in xennet_change_mtu()
1393 struct netfront_stats *rx_stats = per_cpu_ptr(np->rx_stats, cpu); in xennet_get_stats64()
1394 struct netfront_stats *tx_stats = per_cpu_ptr(np->tx_stats, cpu); in xennet_get_stats64()
1399 start = u64_stats_fetch_begin_irq(&tx_stats->syncp); in xennet_get_stats64()
1400 tx_packets = tx_stats->packets; in xennet_get_stats64()
1401 tx_bytes = tx_stats->bytes; in xennet_get_stats64()
1402 } while (u64_stats_fetch_retry_irq(&tx_stats->syncp, start)); in xennet_get_stats64()
1405 start = u64_stats_fetch_begin_irq(&rx_stats->syncp); in xennet_get_stats64()
1406 rx_packets = rx_stats->packets; in xennet_get_stats64()
1407 rx_bytes = rx_stats->bytes; in xennet_get_stats64()
1408 } while (u64_stats_fetch_retry_irq(&rx_stats->syncp, start)); in xennet_get_stats64()
1410 tot->rx_packets += rx_packets; in xennet_get_stats64()
1411 tot->tx_packets += tx_packets; in xennet_get_stats64()
1412 tot->rx_bytes += rx_bytes; in xennet_get_stats64()
1413 tot->tx_bytes += tx_bytes; in xennet_get_stats64()
1416 tot->rx_errors = dev->stats.rx_errors; in xennet_get_stats64()
1417 tot->tx_dropped = dev->stats.tx_dropped; in xennet_get_stats64()
1420 static void xennet_release_tx_bufs(struct netfront_queue *queue) in xennet_release_tx_bufs() argument
1427 if (!queue->tx_skbs[i]) in xennet_release_tx_bufs()
1430 skb = queue->tx_skbs[i]; in xennet_release_tx_bufs()
1431 queue->tx_skbs[i] = NULL; in xennet_release_tx_bufs()
1432 get_page(queue->grant_tx_page[i]); in xennet_release_tx_bufs()
1433 gnttab_end_foreign_access(queue->grant_tx_ref[i], in xennet_release_tx_bufs()
1435 (unsigned long)page_address(queue->grant_tx_page[i])); in xennet_release_tx_bufs()
1436 queue->grant_tx_page[i] = NULL; in xennet_release_tx_bufs()
1437 queue->grant_tx_ref[i] = GRANT_INVALID_REF; in xennet_release_tx_bufs()
1438 add_id_to_list(&queue->tx_skb_freelist, queue->tx_link, i); in xennet_release_tx_bufs()
1443 static void xennet_release_rx_bufs(struct netfront_queue *queue) in xennet_release_rx_bufs() argument
1447 spin_lock_bh(&queue->rx_lock); in xennet_release_rx_bufs()
1453 skb = queue->rx_skbs[id]; in xennet_release_rx_bufs()
1457 ref = queue->grant_rx_ref[id]; in xennet_release_rx_bufs()
1461 page = skb_frag_page(&skb_shinfo(skb)->frags[0]); in xennet_release_rx_bufs()
1469 queue->grant_rx_ref[id] = GRANT_INVALID_REF; in xennet_release_rx_bufs()
1474 spin_unlock_bh(&queue->rx_lock); in xennet_release_rx_bufs()
1483 !xenbus_read_unsigned(np->xbdev->otherend, "feature-sg", 0)) in xennet_fix_features()
1487 !xenbus_read_unsigned(np->xbdev->otherend, in xennet_fix_features()
1488 "feature-ipv6-csum-offload", 0)) in xennet_fix_features()
1492 !xenbus_read_unsigned(np->xbdev->otherend, "feature-gso-tcpv4", 0)) in xennet_fix_features()
1496 !xenbus_read_unsigned(np->xbdev->otherend, "feature-gso-tcpv6", 0)) in xennet_fix_features()
1505 if (!(features & NETIF_F_SG) && dev->mtu > ETH_DATA_LEN) { in xennet_set_features()
1507 dev->mtu = ETH_DATA_LEN; in xennet_set_features()
1513 static bool xennet_handle_tx(struct netfront_queue *queue, unsigned int *eoi) in xennet_handle_tx() argument
1517 if (unlikely(queue->info->broken)) in xennet_handle_tx()
1520 spin_lock_irqsave(&queue->tx_lock, flags); in xennet_handle_tx()
1521 if (xennet_tx_buf_gc(queue)) in xennet_handle_tx()
1523 spin_unlock_irqrestore(&queue->tx_lock, flags); in xennet_handle_tx()
1538 static bool xennet_handle_rx(struct netfront_queue *queue, unsigned int *eoi) in xennet_handle_rx() argument
1543 if (unlikely(queue->info->broken)) in xennet_handle_rx()
1546 spin_lock_irqsave(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1547 work_queued = RING_HAS_UNCONSUMED_RESPONSES(&queue->rx); in xennet_handle_rx()
1548 if (work_queued > queue->rx_rsp_unconsumed) { in xennet_handle_rx()
1549 queue->rx_rsp_unconsumed = work_queued; in xennet_handle_rx()
1551 } else if (unlikely(work_queued < queue->rx_rsp_unconsumed)) { in xennet_handle_rx()
1552 const struct device *dev = &queue->info->netdev->dev; in xennet_handle_rx()
1554 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1555 dev_alert(dev, "RX producer index going backwards\n"); in xennet_handle_rx()
1557 queue->info->broken = true; in xennet_handle_rx()
1560 spin_unlock_irqrestore(&queue->rx_cons_lock, flags); in xennet_handle_rx()
1562 if (likely(netif_carrier_ok(queue->info->netdev) && work_queued)) in xennet_handle_rx()
1563 napi_schedule(&queue->napi); in xennet_handle_rx()
1592 /* Poll each queue */ in xennet_poll_controller()
1594 unsigned int num_queues = dev->real_num_tx_queues; in xennet_poll_controller()
1597 if (info->broken) in xennet_poll_controller()
1601 xennet_interrupt(0, &info->queues[i]); in xennet_poll_controller()
1614 err = xenbus_printf(XBT_NIL, np->xbdev->nodename, in talk_to_netback_xdp()
1615 "xdp-headroom", "%hu", in talk_to_netback_xdp()
1618 pr_warn("Error writing xdp-headroom\n"); in talk_to_netback_xdp()
1626 unsigned long max_mtu = XEN_PAGE_SIZE - XDP_PACKET_HEADROOM; in xennet_xdp_set()
1631 if (dev->mtu > max_mtu) { in xennet_xdp_set()
1633 return -EINVAL; in xennet_xdp_set()
1636 if (!np->netback_has_xdp_headroom) in xennet_xdp_set()
1639 xenbus_switch_state(np->xbdev, XenbusStateReconfiguring); in xennet_xdp_set()
1648 xenbus_read_driver_state(np->xbdev->otherend) == in xennet_xdp_set()
1650 np->netfront_xdp_enabled = true; in xennet_xdp_set()
1652 old_prog = rtnl_dereference(np->queues[0].xdp_prog); in xennet_xdp_set()
1655 bpf_prog_add(prog, dev->real_num_tx_queues); in xennet_xdp_set()
1657 for (i = 0; i < dev->real_num_tx_queues; ++i) in xennet_xdp_set()
1658 rcu_assign_pointer(np->queues[i].xdp_prog, prog); in xennet_xdp_set()
1661 for (i = 0; i < dev->real_num_tx_queues; ++i) in xennet_xdp_set()
1664 xenbus_switch_state(np->xbdev, XenbusStateConnected); in xennet_xdp_set()
1673 if (np->broken) in xennet_xdp()
1674 return -ENODEV; in xennet_xdp()
1676 switch (xdp->command) { in xennet_xdp()
1678 return xennet_xdp_set(dev, xdp->prog, xdp->extack); in xennet_xdp()
1680 return -EINVAL; in xennet_xdp()
1707 free_percpu(np->rx_stats); in xennet_free_netdev()
1708 free_percpu(np->tx_stats); in xennet_free_netdev()
1720 return ERR_PTR(-ENOMEM); in xennet_create_dev()
1723 np->xbdev = dev; in xennet_create_dev()
1725 np->queues = NULL; in xennet_create_dev()
1727 err = -ENOMEM; in xennet_create_dev()
1728 np->rx_stats = netdev_alloc_pcpu_stats(struct netfront_stats); in xennet_create_dev()
1729 if (np->rx_stats == NULL) in xennet_create_dev()
1731 np->tx_stats = netdev_alloc_pcpu_stats(struct netfront_stats); in xennet_create_dev()
1732 if (np->tx_stats == NULL) in xennet_create_dev()
1735 netdev->netdev_ops = &xennet_netdev_ops; in xennet_create_dev()
1737 netdev->features = NETIF_F_IP_CSUM | NETIF_F_RXCSUM | in xennet_create_dev()
1739 netdev->hw_features = NETIF_F_SG | in xennet_create_dev()
1749 netdev->features |= netdev->hw_features; in xennet_create_dev()
1751 netdev->ethtool_ops = &xennet_ethtool_ops; in xennet_create_dev()
1752 netdev->min_mtu = ETH_MIN_MTU; in xennet_create_dev()
1753 netdev->max_mtu = XEN_NETIF_MAX_TX_SIZE; in xennet_create_dev()
1754 SET_NETDEV_DEV(netdev, &dev->dev); in xennet_create_dev()
1756 np->netdev = netdev; in xennet_create_dev()
1757 np->netfront_xdp_enabled = false; in xennet_create_dev()
1764 xenbus_read_driver_state(dev->otherend) != in xennet_create_dev()
1766 xenbus_read_driver_state(dev->otherend) != in xennet_create_dev()
1797 dev_set_drvdata(&dev->dev, info); in netfront_probe()
1799 info->netdev->sysfs_groups[0] = &xennet_dev_group; in netfront_probe()
1807 /* This frees the page as a side-effect */ in xennet_end_access()
1815 unsigned int num_queues = info->netdev->real_num_tx_queues; in xennet_disconnect_backend()
1817 netif_carrier_off(info->netdev); in xennet_disconnect_backend()
1819 for (i = 0; i < num_queues && info->queues; ++i) { in xennet_disconnect_backend()
1820 struct netfront_queue *queue = &info->queues[i]; in xennet_disconnect_backend() local
1822 del_timer_sync(&queue->rx_refill_timer); in xennet_disconnect_backend()
1824 if (queue->tx_irq && (queue->tx_irq == queue->rx_irq)) in xennet_disconnect_backend()
1825 unbind_from_irqhandler(queue->tx_irq, queue); in xennet_disconnect_backend()
1826 if (queue->tx_irq && (queue->tx_irq != queue->rx_irq)) { in xennet_disconnect_backend()
1827 unbind_from_irqhandler(queue->tx_irq, queue); in xennet_disconnect_backend()
1828 unbind_from_irqhandler(queue->rx_irq, queue); in xennet_disconnect_backend()
1830 queue->tx_evtchn = queue->rx_evtchn = 0; in xennet_disconnect_backend()
1831 queue->tx_irq = queue->rx_irq = 0; in xennet_disconnect_backend()
1833 if (netif_running(info->netdev)) in xennet_disconnect_backend()
1834 napi_synchronize(&queue->napi); in xennet_disconnect_backend()
1836 xennet_release_tx_bufs(queue); in xennet_disconnect_backend()
1837 xennet_release_rx_bufs(queue); in xennet_disconnect_backend()
1838 gnttab_free_grant_references(queue->gref_tx_head); in xennet_disconnect_backend()
1839 gnttab_free_grant_references(queue->gref_rx_head); in xennet_disconnect_backend()
1842 xennet_end_access(queue->tx_ring_ref, queue->tx.sring); in xennet_disconnect_backend()
1843 xennet_end_access(queue->rx_ring_ref, queue->rx.sring); in xennet_disconnect_backend()
1845 queue->tx_ring_ref = GRANT_INVALID_REF; in xennet_disconnect_backend()
1846 queue->rx_ring_ref = GRANT_INVALID_REF; in xennet_disconnect_backend()
1847 queue->tx.sring = NULL; in xennet_disconnect_backend()
1848 queue->rx.sring = NULL; in xennet_disconnect_backend()
1850 page_pool_destroy(queue->page_pool); in xennet_disconnect_backend()
1857 * leave the device-layer structures intact so that this is transparent to the
1862 struct netfront_info *info = dev_get_drvdata(&dev->dev); in netfront_resume()
1864 dev_dbg(&dev->dev, "%s\n", dev->nodename); in netfront_resume()
1866 netif_tx_lock_bh(info->netdev); in netfront_resume()
1867 netif_device_detach(info->netdev); in netfront_resume()
1868 netif_tx_unlock_bh(info->netdev); in netfront_resume()
1873 if (info->queues) in netfront_resume()
1885 macstr = s = xenbus_read(XBT_NIL, dev->nodename, "mac", NULL); in xen_net_read_mac()
1891 if ((s == e) || (*e != ((i == ETH_ALEN-1) ? '\0' : ':'))) { in xen_net_read_mac()
1893 return -ENOENT; in xen_net_read_mac()
1902 static int setup_netfront_single(struct netfront_queue *queue) in setup_netfront_single() argument
1906 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->tx_evtchn); in setup_netfront_single()
1910 err = bind_evtchn_to_irqhandler_lateeoi(queue->tx_evtchn, in setup_netfront_single()
1912 queue->info->netdev->name, in setup_netfront_single()
1913 queue); in setup_netfront_single()
1916 queue->rx_evtchn = queue->tx_evtchn; in setup_netfront_single()
1917 queue->rx_irq = queue->tx_irq = err; in setup_netfront_single()
1922 xenbus_free_evtchn(queue->info->xbdev, queue->tx_evtchn); in setup_netfront_single()
1923 queue->tx_evtchn = 0; in setup_netfront_single()
1928 static int setup_netfront_split(struct netfront_queue *queue) in setup_netfront_split() argument
1932 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->tx_evtchn); in setup_netfront_split()
1935 err = xenbus_alloc_evtchn(queue->info->xbdev, &queue->rx_evtchn); in setup_netfront_split()
1939 snprintf(queue->tx_irq_name, sizeof(queue->tx_irq_name), in setup_netfront_split()
1940 "%s-tx", queue->name); in setup_netfront_split()
1941 err = bind_evtchn_to_irqhandler_lateeoi(queue->tx_evtchn, in setup_netfront_split()
1943 queue->tx_irq_name, queue); in setup_netfront_split()
1946 queue->tx_irq = err; in setup_netfront_split()
1948 snprintf(queue->rx_irq_name, sizeof(queue->rx_irq_name), in setup_netfront_split()
1949 "%s-rx", queue->name); in setup_netfront_split()
1950 err = bind_evtchn_to_irqhandler_lateeoi(queue->rx_evtchn, in setup_netfront_split()
1952 queue->rx_irq_name, queue); in setup_netfront_split()
1955 queue->rx_irq = err; in setup_netfront_split()
1960 unbind_from_irqhandler(queue->tx_irq, queue); in setup_netfront_split()
1961 queue->tx_irq = 0; in setup_netfront_split()
1963 xenbus_free_evtchn(queue->info->xbdev, queue->rx_evtchn); in setup_netfront_split()
1964 queue->rx_evtchn = 0; in setup_netfront_split()
1966 xenbus_free_evtchn(queue->info->xbdev, queue->tx_evtchn); in setup_netfront_split()
1967 queue->tx_evtchn = 0; in setup_netfront_split()
1973 struct netfront_queue *queue, unsigned int feature_split_evtchn) in setup_netfront() argument
1980 queue->tx_ring_ref = GRANT_INVALID_REF; in setup_netfront()
1981 queue->rx_ring_ref = GRANT_INVALID_REF; in setup_netfront()
1982 queue->rx.sring = NULL; in setup_netfront()
1983 queue->tx.sring = NULL; in setup_netfront()
1987 err = -ENOMEM; in setup_netfront()
1992 FRONT_RING_INIT(&queue->tx, txs, XEN_PAGE_SIZE); in setup_netfront()
1997 queue->tx_ring_ref = gref; in setup_netfront()
2001 err = -ENOMEM; in setup_netfront()
2002 xenbus_dev_fatal(dev, err, "allocating rx ring page"); in setup_netfront()
2006 FRONT_RING_INIT(&queue->rx, rxs, XEN_PAGE_SIZE); in setup_netfront()
2011 queue->rx_ring_ref = gref; in setup_netfront()
2014 err = setup_netfront_split(queue); in setup_netfront()
2016 * a) feature-split-event-channels == 0 in setup_netfront()
2017 * b) feature-split-event-channels == 1 but failed to setup in setup_netfront()
2020 err = setup_netfront_single(queue); in setup_netfront()
2031 if (queue->rx_ring_ref != GRANT_INVALID_REF) { in setup_netfront()
2032 gnttab_end_foreign_access(queue->rx_ring_ref, 0, in setup_netfront()
2034 queue->rx_ring_ref = GRANT_INVALID_REF; in setup_netfront()
2038 if (queue->tx_ring_ref != GRANT_INVALID_REF) { in setup_netfront()
2039 gnttab_end_foreign_access(queue->tx_ring_ref, 0, in setup_netfront()
2041 queue->tx_ring_ref = GRANT_INVALID_REF; in setup_netfront()
2048 /* Queue-specific initialisation
2050 * be run per-queue.
2052 static int xennet_init_queue(struct netfront_queue *queue) in xennet_init_queue() argument
2058 spin_lock_init(&queue->tx_lock); in xennet_init_queue()
2059 spin_lock_init(&queue->rx_lock); in xennet_init_queue()
2060 spin_lock_init(&queue->rx_cons_lock); in xennet_init_queue()
2062 timer_setup(&queue->rx_refill_timer, rx_refill_timeout, 0); in xennet_init_queue()
2064 devid = strrchr(queue->info->xbdev->nodename, '/') + 1; in xennet_init_queue()
2065 snprintf(queue->name, sizeof(queue->name), "vif%s-q%u", in xennet_init_queue()
2066 devid, queue->id); in xennet_init_queue()
2069 queue->tx_skb_freelist = 0; in xennet_init_queue()
2070 queue->tx_pend_queue = TX_LINK_NONE; in xennet_init_queue()
2072 queue->tx_link[i] = i + 1; in xennet_init_queue()
2073 queue->grant_tx_ref[i] = GRANT_INVALID_REF; in xennet_init_queue()
2074 queue->grant_tx_page[i] = NULL; in xennet_init_queue()
2076 queue->tx_link[NET_TX_RING_SIZE - 1] = TX_LINK_NONE; in xennet_init_queue()
2080 queue->rx_skbs[i] = NULL; in xennet_init_queue()
2081 queue->grant_rx_ref[i] = GRANT_INVALID_REF; in xennet_init_queue()
2086 &queue->gref_tx_head) < 0) { in xennet_init_queue()
2088 err = -ENOMEM; in xennet_init_queue()
2092 /* A grant for every rx ring slot */ in xennet_init_queue()
2094 &queue->gref_rx_head) < 0) { in xennet_init_queue()
2095 pr_alert("can't alloc rx grant refs\n"); in xennet_init_queue()
2096 err = -ENOMEM; in xennet_init_queue()
2103 gnttab_free_grant_references(queue->gref_tx_head); in xennet_init_queue()
2108 static int write_queue_xenstore_keys(struct netfront_queue *queue, in write_queue_xenstore_keys() argument
2111 /* Write the queue-specific keys into XenStore in the traditional in write_queue_xenstore_keys()
2112 * way for a single queue, or in a queue subkeys for multiple in write_queue_xenstore_keys()
2115 struct xenbus_device *dev = queue->info->xbdev; in write_queue_xenstore_keys()
2123 pathsize = strlen(dev->nodename) + 10; in write_queue_xenstore_keys()
2126 err = -ENOMEM; in write_queue_xenstore_keys()
2130 snprintf(path, pathsize, "%s/queue-%u", in write_queue_xenstore_keys()
2131 dev->nodename, queue->id); in write_queue_xenstore_keys()
2133 path = (char *)dev->nodename; in write_queue_xenstore_keys()
2137 err = xenbus_printf(*xbt, path, "tx-ring-ref", "%u", in write_queue_xenstore_keys()
2138 queue->tx_ring_ref); in write_queue_xenstore_keys()
2140 message = "writing tx-ring-ref"; in write_queue_xenstore_keys()
2144 err = xenbus_printf(*xbt, path, "rx-ring-ref", "%u", in write_queue_xenstore_keys()
2145 queue->rx_ring_ref); in write_queue_xenstore_keys()
2147 message = "writing rx-ring-ref"; in write_queue_xenstore_keys()
2154 if (queue->tx_evtchn == queue->rx_evtchn) { in write_queue_xenstore_keys()
2157 "event-channel", "%u", queue->tx_evtchn); in write_queue_xenstore_keys()
2159 message = "writing event-channel"; in write_queue_xenstore_keys()
2165 "event-channel-tx", "%u", queue->tx_evtchn); in write_queue_xenstore_keys()
2167 message = "writing event-channel-tx"; in write_queue_xenstore_keys()
2172 "event-channel-rx", "%u", queue->rx_evtchn); in write_queue_xenstore_keys()
2174 message = "writing event-channel-rx"; in write_queue_xenstore_keys()
2192 static int xennet_create_page_pool(struct netfront_queue *queue) in xennet_create_page_pool() argument
2200 .dev = &queue->info->netdev->dev, in xennet_create_page_pool()
2202 .max_len = XEN_PAGE_SIZE - XDP_PACKET_HEADROOM, in xennet_create_page_pool()
2205 queue->page_pool = page_pool_create(&pp_params); in xennet_create_page_pool()
2206 if (IS_ERR(queue->page_pool)) { in xennet_create_page_pool()
2207 err = PTR_ERR(queue->page_pool); in xennet_create_page_pool()
2208 queue->page_pool = NULL; in xennet_create_page_pool()
2212 err = xdp_rxq_info_reg(&queue->xdp_rxq, queue->info->netdev, in xennet_create_page_pool()
2213 queue->id); in xennet_create_page_pool()
2215 netdev_err(queue->info->netdev, "xdp_rxq_info_reg failed\n"); in xennet_create_page_pool()
2219 err = xdp_rxq_info_reg_mem_model(&queue->xdp_rxq, in xennet_create_page_pool()
2220 MEM_TYPE_PAGE_POOL, queue->page_pool); in xennet_create_page_pool()
2222 netdev_err(queue->info->netdev, "xdp_rxq_info_reg_mem_model failed\n"); in xennet_create_page_pool()
2228 xdp_rxq_info_unreg(&queue->xdp_rxq); in xennet_create_page_pool()
2230 page_pool_destroy(queue->page_pool); in xennet_create_page_pool()
2231 queue->page_pool = NULL; in xennet_create_page_pool()
2241 info->queues = kcalloc(*num_queues, sizeof(struct netfront_queue), in xennet_create_queues()
2243 if (!info->queues) in xennet_create_queues()
2244 return -ENOMEM; in xennet_create_queues()
2247 struct netfront_queue *queue = &info->queues[i]; in xennet_create_queues() local
2249 queue->id = i; in xennet_create_queues()
2250 queue->info = info; in xennet_create_queues()
2252 ret = xennet_init_queue(queue); in xennet_create_queues()
2254 dev_warn(&info->xbdev->dev, in xennet_create_queues()
2261 ret = xennet_create_page_pool(queue); in xennet_create_queues()
2263 dev_err(&info->xbdev->dev, "can't allocate page pool\n"); in xennet_create_queues()
2268 netif_napi_add(queue->info->netdev, &queue->napi, in xennet_create_queues()
2270 if (netif_running(info->netdev)) in xennet_create_queues()
2271 napi_enable(&queue->napi); in xennet_create_queues()
2274 netif_set_real_num_tx_queues(info->netdev, *num_queues); in xennet_create_queues()
2277 dev_err(&info->xbdev->dev, "no queues\n"); in xennet_create_queues()
2278 return -EINVAL; in xennet_create_queues()
2293 struct netfront_queue *queue = NULL; in talk_to_netback() local
2296 info->netdev->irq = 0; in talk_to_netback()
2299 info->bounce = !xennet_trusted || in talk_to_netback()
2300 !xenbus_read_unsigned(dev->nodename, "trusted", 1); in talk_to_netback()
2303 max_queues = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2304 "multi-queue-max-queues", 1); in talk_to_netback()
2307 /* Check feature-split-event-channels */ in talk_to_netback()
2308 feature_split_evtchn = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2309 "feature-split-event-channels", 0); in talk_to_netback()
2312 err = xen_net_read_mac(dev, info->netdev->dev_addr); in talk_to_netback()
2314 xenbus_dev_fatal(dev, err, "parsing %s/mac", dev->nodename); in talk_to_netback()
2318 info->netback_has_xdp_headroom = xenbus_read_unsigned(info->xbdev->otherend, in talk_to_netback()
2319 "feature-xdp-headroom", 0); in talk_to_netback()
2320 if (info->netback_has_xdp_headroom) { in talk_to_netback()
2321 /* set the current xen-netfront xdp state */ in talk_to_netback()
2322 err = talk_to_netback_xdp(info, info->netfront_xdp_enabled ? in talk_to_netback()
2330 if (info->queues) in talk_to_netback()
2334 info->broken = false; in talk_to_netback()
2339 kfree(info->queues); in talk_to_netback()
2340 info->queues = NULL; in talk_to_netback()
2345 /* Create shared ring, alloc event channel -- for each queue */ in talk_to_netback()
2347 queue = &info->queues[i]; in talk_to_netback()
2348 err = setup_netfront(dev, queue, feature_split_evtchn); in talk_to_netback()
2361 info->xbdev->otherend, "multi-queue-max-queues")) { in talk_to_netback()
2363 err = xenbus_printf(xbt, dev->nodename, in talk_to_netback()
2364 "multi-queue-num-queues", "%u", num_queues); in talk_to_netback()
2366 message = "writing multi-queue-num-queues"; in talk_to_netback()
2372 err = write_queue_xenstore_keys(&info->queues[0], &xbt, 0); /* flat */ in talk_to_netback()
2376 /* Write the keys for each queue */ in talk_to_netback()
2378 queue = &info->queues[i]; in talk_to_netback()
2379 err = write_queue_xenstore_keys(queue, &xbt, 1); /* hierarchical */ in talk_to_netback()
2385 /* The remaining keys are not queue-specific */ in talk_to_netback()
2386 err = xenbus_printf(xbt, dev->nodename, "request-rx-copy", "%u", in talk_to_netback()
2389 message = "writing request-rx-copy"; in talk_to_netback()
2393 err = xenbus_printf(xbt, dev->nodename, "feature-rx-notify", "%d", 1); in talk_to_netback()
2395 message = "writing feature-rx-notify"; in talk_to_netback()
2399 err = xenbus_printf(xbt, dev->nodename, "feature-sg", "%d", 1); in talk_to_netback()
2401 message = "writing feature-sg"; in talk_to_netback()
2405 err = xenbus_printf(xbt, dev->nodename, "feature-gso-tcpv4", "%d", 1); in talk_to_netback()
2407 message = "writing feature-gso-tcpv4"; in talk_to_netback()
2411 err = xenbus_write(xbt, dev->nodename, "feature-gso-tcpv6", "1"); in talk_to_netback()
2413 message = "writing feature-gso-tcpv6"; in talk_to_netback()
2417 err = xenbus_write(xbt, dev->nodename, "feature-ipv6-csum-offload", in talk_to_netback()
2420 message = "writing feature-ipv6-csum-offload"; in talk_to_netback()
2426 if (err == -EAGAIN) in talk_to_netback()
2445 device_unregister(&dev->dev); in talk_to_netback()
2455 struct netfront_queue *queue = NULL; in xennet_connect() local
2457 if (!xenbus_read_unsigned(np->xbdev->otherend, "feature-rx-copy", 0)) { in xennet_connect()
2458 dev_info(&dev->dev, in xennet_connect()
2460 return -ENODEV; in xennet_connect()
2463 err = talk_to_netback(np->xbdev, np); in xennet_connect()
2466 if (np->netback_has_xdp_headroom) in xennet_connect()
2468 if (np->bounce) in xennet_connect()
2469 dev_info(&np->xbdev->dev, in xennet_connect()
2473 num_queues = dev->real_num_tx_queues; in xennet_connect()
2475 if (dev->reg_state == NETREG_UNINITIALIZED) { in xennet_connect()
2479 device_unregister(&np->xbdev->dev); in xennet_connect()
2494 netif_tx_lock_bh(np->netdev); in xennet_connect()
2495 netif_device_attach(np->netdev); in xennet_connect()
2496 netif_tx_unlock_bh(np->netdev); in xennet_connect()
2498 netif_carrier_on(np->netdev); in xennet_connect()
2500 queue = &np->queues[j]; in xennet_connect()
2502 notify_remote_via_irq(queue->tx_irq); in xennet_connect()
2503 if (queue->tx_irq != queue->rx_irq) in xennet_connect()
2504 notify_remote_via_irq(queue->rx_irq); in xennet_connect()
2506 spin_lock_irq(&queue->tx_lock); in xennet_connect()
2507 xennet_tx_buf_gc(queue); in xennet_connect()
2508 spin_unlock_irq(&queue->tx_lock); in xennet_connect()
2510 spin_lock_bh(&queue->rx_lock); in xennet_connect()
2511 xennet_alloc_rx_buffers(queue); in xennet_connect()
2512 spin_unlock_bh(&queue->rx_lock); in xennet_connect()
2524 struct netfront_info *np = dev_get_drvdata(&dev->dev); in netback_changed()
2525 struct net_device *netdev = np->netdev; in netback_changed()
2527 dev_dbg(&dev->dev, "%s\n", xenbus_strstate(backend_state)); in netback_changed()
2540 if (dev->state != XenbusStateInitialising) in netback_changed()
2552 if (dev->state == XenbusStateClosed) in netback_changed()
2577 return -EINVAL; in xennet_get_sset_count()
2629 return -EPERM; in store_rxbuf()
2633 return -EBADMSG; in store_rxbuf()
2660 if (xenbus_read_driver_state(dev->otherend) == XenbusStateClosed) in xennet_bus_close()
2665 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2667 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2669 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2674 if (xenbus_read_driver_state(dev->otherend) == XenbusStateClosed) in xennet_bus_close()
2680 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2682 xenbus_read_driver_state(dev->otherend) == in xennet_bus_close()
2690 struct netfront_info *info = dev_get_drvdata(&dev->dev); in xennet_remove()
2695 if (info->netdev->reg_state == NETREG_REGISTERED) in xennet_remove()
2696 unregister_netdev(info->netdev); in xennet_remove()
2698 if (info->queues) { in xennet_remove()
2703 xennet_free_netdev(info->netdev); in xennet_remove()
2724 return -ENODEV; in netif_init()
2727 return -ENODEV; in netif_init()