forked from ~ljy/RK356X_SDK_RELEASE
blame | history | patch | commit | commitdiff
hc
2023-12-11 072de836f53be56a70cecf70b43ae43b7ce17376 
 kernel/drivers/ntb/ntb_transport.c
....@@ -93,6 +93,12 @@
9393 module_param(use_dma, bool, 0644);
9494 MODULE_PARM_DESC(use_dma, "Use DMA engine to perform large data copy");
9595 
96
+static bool use_msi;
97
+#ifdef CONFIG_NTB_MSI
98
+module_param(use_msi, bool, 0644);
99
+MODULE_PARM_DESC(use_msi, "Use MSI interrupts instead of doorbells");
100
+#endif
101
+
96102 static struct dentry *nt_debugfs_dir;
97103 
98104 /* Only two-ports NTB devices are supported */
....@@ -144,7 +150,9 @@
144150 	struct list_head tx_free_q;
145151 	spinlock_t ntb_tx_free_q_lock;
146152 	void __iomem *tx_mw;
147
-	dma_addr_t tx_mw_phys;
153
+	phys_addr_t tx_mw_phys;
154
+	size_t tx_mw_size;
155
+	dma_addr_t tx_mw_dma_addr;
148156 	unsigned int tx_index;
149157 	unsigned int tx_max_entry;
150158 	unsigned int tx_max_frame;
....@@ -186,6 +194,11 @@
186194 	u64 tx_err_no_buf;
187195 	u64 tx_memcpy;
188196 	u64 tx_async;
197
+
198
+	bool use_msi;
199
+	int msi_irq;
200
+	struct ntb_msi_desc msi_desc;
201
+	struct ntb_msi_desc peer_msi_desc;
189202 };
190203 
191204 struct ntb_transport_mw {
....@@ -194,6 +207,8 @@
194207 	void __iomem *vbase;
195208 	size_t xlat_size;
196209 	size_t buff_size;
210
+	size_t alloc_size;
211
+	void *alloc_addr;
197212 	void *virt_addr;
198213 	dma_addr_t dma_addr;
199214 };
....@@ -216,6 +231,10 @@
216231 	unsigned int qp_count;
217232 	u64 qp_bitmap;
218233 	u64 qp_bitmap_free;
234
+
235
+	bool use_msi;
236
+	unsigned int msi_spad_offset;
237
+	u64 msi_db_mask;
219238 
220239 	bool link_is_up;
221240 	struct delayed_work link_work;
....@@ -273,7 +292,7 @@
273292 static int ntb_transport_bus_probe(struct device *dev)
274293 {
275294 	const struct ntb_transport_client *client;
276
-	int rc = -EINVAL;
295
+	int rc;
277296 
278297 	get_device(dev);
279298 
....@@ -462,70 +481,70 @@
462481 		return -ENOMEM;
463482 
464483 	out_offset = 0;
465
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
484
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
466485 			       "\nNTB QP stats:\n\n");
467
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
486
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
468487 			       "rx_bytes - \t%llu\n", qp->rx_bytes);
469
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
488
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
470489 			       "rx_pkts - \t%llu\n", qp->rx_pkts);
471
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
490
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
472491 			       "rx_memcpy - \t%llu\n", qp->rx_memcpy);
473
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
492
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
474493 			       "rx_async - \t%llu\n", qp->rx_async);
475
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
494
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
476495 			       "rx_ring_empty - %llu\n", qp->rx_ring_empty);
477
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
496
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
478497 			       "rx_err_no_buf - %llu\n", qp->rx_err_no_buf);
479
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
498
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
480499 			       "rx_err_oflow - \t%llu\n", qp->rx_err_oflow);
481
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
500
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
482501 			       "rx_err_ver - \t%llu\n", qp->rx_err_ver);
483
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
502
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
484503 			       "rx_buff - \t0x%p\n", qp->rx_buff);
485
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
504
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
486505 			       "rx_index - \t%u\n", qp->rx_index);
487
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
506
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
488507 			       "rx_max_entry - \t%u\n", qp->rx_max_entry);
489
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
508
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
490509 			       "rx_alloc_entry - \t%u\n\n", qp->rx_alloc_entry);
491510 
492
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
511
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
493512 			       "tx_bytes - \t%llu\n", qp->tx_bytes);
494
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
513
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
495514 			       "tx_pkts - \t%llu\n", qp->tx_pkts);
496
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
515
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
497516 			       "tx_memcpy - \t%llu\n", qp->tx_memcpy);
498
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
517
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
499518 			       "tx_async - \t%llu\n", qp->tx_async);
500
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
519
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
501520 			       "tx_ring_full - \t%llu\n", qp->tx_ring_full);
502
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
521
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
503522 			       "tx_err_no_buf - %llu\n", qp->tx_err_no_buf);
504
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
523
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
505524 			       "tx_mw - \t0x%p\n", qp->tx_mw);
506
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
525
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
507526 			       "tx_index (H) - \t%u\n", qp->tx_index);
508
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
527
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
509528 			       "RRI (T) - \t%u\n",
510529 			       qp->remote_rx_info->entry);
511
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
530
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
512531 			       "tx_max_entry - \t%u\n", qp->tx_max_entry);
513
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
532
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
514533 			       "free tx - \t%u\n",
515534 			       ntb_transport_tx_free_entry(qp));
516535 
517
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
536
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
518537 			       "\n");
519
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
538
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
520539 			       "Using TX DMA - \t%s\n",
521540 			       qp->tx_dma_chan ? "Yes" : "No");
522
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
541
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
523542 			       "Using RX DMA - \t%s\n",
524543 			       qp->rx_dma_chan ? "Yes" : "No");
525
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
544
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
526545 			       "QP Link - \t%s\n",
527546 			       qp->link_is_up ? "Up" : "Down");
528
-	out_offset += snprintf(buf + out_offset, out_count - out_offset,
547
+	out_offset += scnprintf(buf + out_offset, out_count - out_offset,
529548 			       "\n");
530549 
531550 	if (out_offset > out_count)
....@@ -663,6 +682,114 @@
663682 	return 0;
664683 }
665684 
685
+static irqreturn_t ntb_transport_isr(int irq, void *dev)
686
+{
687
+	struct ntb_transport_qp *qp = dev;
688
+
689
+	tasklet_schedule(&qp->rxc_db_work);
690
+
691
+	return IRQ_HANDLED;
692
+}
693
+
694
+static void ntb_transport_setup_qp_peer_msi(struct ntb_transport_ctx *nt,
695
+					    unsigned int qp_num)
696
+{
697
+	struct ntb_transport_qp *qp = &nt->qp_vec[qp_num];
698
+	int spad = qp_num * 2 + nt->msi_spad_offset;
699
+
700
+	if (!nt->use_msi)
701
+		return;
702
+
703
+	if (spad >= ntb_spad_count(nt->ndev))
704
+		return;
705
+
706
+	qp->peer_msi_desc.addr_offset =
707
+		ntb_peer_spad_read(qp->ndev, PIDX, spad);
708
+	qp->peer_msi_desc.data =
709
+		ntb_peer_spad_read(qp->ndev, PIDX, spad + 1);
710
+
711
+	dev_dbg(&qp->ndev->pdev->dev, "QP%d Peer MSI addr=%x data=%x\n",
712
+		qp_num, qp->peer_msi_desc.addr_offset, qp->peer_msi_desc.data);
713
+
714
+	if (qp->peer_msi_desc.addr_offset) {
715
+		qp->use_msi = true;
716
+		dev_info(&qp->ndev->pdev->dev,
717
+			 "Using MSI interrupts for QP%d\n", qp_num);
718
+	}
719
+}
720
+
721
+static void ntb_transport_setup_qp_msi(struct ntb_transport_ctx *nt,
722
+				       unsigned int qp_num)
723
+{
724
+	struct ntb_transport_qp *qp = &nt->qp_vec[qp_num];
725
+	int spad = qp_num * 2 + nt->msi_spad_offset;
726
+	int rc;
727
+
728
+	if (!nt->use_msi)
729
+		return;
730
+
731
+	if (spad >= ntb_spad_count(nt->ndev)) {
732
+		dev_warn_once(&qp->ndev->pdev->dev,
733
+			      "Not enough SPADS to use MSI interrupts\n");
734
+		return;
735
+	}
736
+
737
+	ntb_spad_write(qp->ndev, spad, 0);
738
+	ntb_spad_write(qp->ndev, spad + 1, 0);
739
+
740
+	if (!qp->msi_irq) {
741
+		qp->msi_irq = ntbm_msi_request_irq(qp->ndev, ntb_transport_isr,
742
+						   KBUILD_MODNAME, qp,
743
+						   &qp->msi_desc);
744
+		if (qp->msi_irq < 0) {
745
+			dev_warn(&qp->ndev->pdev->dev,
746
+				 "Unable to allocate MSI interrupt for qp%d\n",
747
+				 qp_num);
748
+			return;
749
+		}
750
+	}
751
+
752
+	rc = ntb_spad_write(qp->ndev, spad, qp->msi_desc.addr_offset);
753
+	if (rc)
754
+		goto err_free_interrupt;
755
+
756
+	rc = ntb_spad_write(qp->ndev, spad + 1, qp->msi_desc.data);
757
+	if (rc)
758
+		goto err_free_interrupt;
759
+
760
+	dev_dbg(&qp->ndev->pdev->dev, "QP%d MSI %d addr=%x data=%x\n",
761
+		qp_num, qp->msi_irq, qp->msi_desc.addr_offset,
762
+		qp->msi_desc.data);
763
+
764
+	return;
765
+
766
+err_free_interrupt:
767
+	devm_free_irq(&nt->ndev->dev, qp->msi_irq, qp);
768
+}
769
+
770
+static void ntb_transport_msi_peer_desc_changed(struct ntb_transport_ctx *nt)
771
+{
772
+	int i;
773
+
774
+	dev_dbg(&nt->ndev->pdev->dev, "Peer MSI descriptors changed");
775
+
776
+	for (i = 0; i < nt->qp_count; i++)
777
+		ntb_transport_setup_qp_peer_msi(nt, i);
778
+}
779
+
780
+static void ntb_transport_msi_desc_changed(void *data)
781
+{
782
+	struct ntb_transport_ctx *nt = data;
783
+	int i;
784
+
785
+	dev_dbg(&nt->ndev->pdev->dev, "MSI descriptors changed");
786
+
787
+	for (i = 0; i < nt->qp_count; i++)
788
+		ntb_transport_setup_qp_msi(nt, i);
789
+
790
+	ntb_peer_db_set(nt->ndev, nt->msi_db_mask);
791
+}
792
+
666793 static void ntb_free_mw(struct ntb_transport_ctx *nt, int num_mw)
667794 {
668795 	struct ntb_transport_mw *mw = &nt->mw_vec[num_mw];
....@@ -672,11 +799,57 @@
672799 		return;
673800 
674801 	ntb_mw_clear_trans(nt->ndev, PIDX, num_mw);
675
-	dma_free_coherent(&pdev->dev, mw->buff_size,
676
-			  mw->virt_addr, mw->dma_addr);
802
+	dma_free_coherent(&pdev->dev, mw->alloc_size,
803
+			  mw->alloc_addr, mw->dma_addr);
677804 	mw->xlat_size = 0;
678805 	mw->buff_size = 0;
806
+	mw->alloc_size = 0;
807
+	mw->alloc_addr = NULL;
679808 	mw->virt_addr = NULL;
809
+}
810
+
811
+static int ntb_alloc_mw_buffer(struct ntb_transport_mw *mw,
812
+			       struct device *dma_dev, size_t align)
813
+{
814
+	dma_addr_t dma_addr;
815
+	void *alloc_addr, *virt_addr;
816
+	int rc;
817
+
818
+	alloc_addr = dma_alloc_coherent(dma_dev, mw->alloc_size,
819
+					&dma_addr, GFP_KERNEL);
820
+	if (!alloc_addr) {
821
+		dev_err(dma_dev, "Unable to alloc MW buff of size %zu\n",
822
+			mw->alloc_size);
823
+		return -ENOMEM;
824
+	}
825
+	virt_addr = alloc_addr;
826
+
827
+	/*
828
+	 * we must ensure that the memory address allocated is BAR size
829
+	 * aligned in order for the XLAT register to take the value. This
830
+	 * is a requirement of the hardware. It is recommended to setup CMA
831
+	 * for BAR sizes equal or greater than 4MB.
832
+	 */
833
+	if (!IS_ALIGNED(dma_addr, align)) {
834
+		if (mw->alloc_size > mw->buff_size) {
835
+			virt_addr = PTR_ALIGN(alloc_addr, align);
836
+			dma_addr = ALIGN(dma_addr, align);
837
+		} else {
838
+			rc = -ENOMEM;
839
+			goto err;
840
+		}
841
+	}
842
+
843
+	mw->alloc_addr = alloc_addr;
844
+	mw->virt_addr = virt_addr;
845
+	mw->dma_addr = dma_addr;
846
+
847
+	return 0;
848
+
849
+err:
850
+	dma_free_coherent(dma_dev, mw->alloc_size, alloc_addr, dma_addr);
851
+
852
+	return rc;
680853 }
681854 
682855 static int ntb_set_mw(struct ntb_transport_ctx *nt, int num_mw,
....@@ -710,28 +883,20 @@
710883 	/* Alloc memory for receiving data.  Must be aligned */
711884 	mw->xlat_size = xlat_size;
712885 	mw->buff_size = buff_size;
886
+	mw->alloc_size = buff_size;
713887 
714
-	mw->virt_addr = dma_alloc_coherent(&pdev->dev, buff_size,
715
-					   &mw->dma_addr, GFP_KERNEL);
716
-	if (!mw->virt_addr) {
717
-		mw->xlat_size = 0;
718
-		mw->buff_size = 0;
719
-		dev_err(&pdev->dev, "Unable to alloc MW buff of size %zu\n",
720
-			buff_size);
721
-		return -ENOMEM;
722
-	}
723
-
724
-	/*
725
-	 * we must ensure that the memory address allocated is BAR size
726
-	 * aligned in order for the XLAT register to take the value. This
727
-	 * is a requirement of the hardware. It is recommended to setup CMA
728
-	 * for BAR sizes equal or greater than 4MB.
729
-	 */
730
-	if (!IS_ALIGNED(mw->dma_addr, xlat_align)) {
731
-		dev_err(&pdev->dev, "DMA memory %pad is not aligned\n",
732
-			&mw->dma_addr);
733
-		ntb_free_mw(nt, num_mw);
734
-		return -ENOMEM;
888
+	rc = ntb_alloc_mw_buffer(mw, &pdev->dev, xlat_align);
889
+	if (rc) {
890
+		mw->alloc_size *= 2;
891
+		rc = ntb_alloc_mw_buffer(mw, &pdev->dev, xlat_align);
892
+		if (rc) {
893
+			dev_err(&pdev->dev,
894
+				"Unable to alloc aligned MW buff\n");
895
+			mw->xlat_size = 0;
896
+			mw->buff_size = 0;
897
+			mw->alloc_size = 0;
898
+			return rc;
899
+		}
735900 	}
736901 
737902 	/* Notify HW the memory location of the receive buffer */
....@@ -822,6 +987,9 @@
822987 	if (!nt->link_is_up)
823988 		cancel_delayed_work_sync(&nt->link_work);
824989 
990
+	for (i = 0; i < nt->mw_count; i++)
991
+		ntb_free_mw(nt, i);
992
+
825993 	/* The scratchpad registers keep the values if the remote side
826994 	 * goes down, blast them now to give them a sane value the next
827995 	 * time they are accessed
....@@ -860,6 +1028,20 @@
8601028 	int rc = 0, i, spad;
8611029 
8621030 	/* send the local info, in the opposite order of the way we read it */
1031
+
1032
+	if (nt->use_msi) {
1033
+		rc = ntb_msi_setup_mws(ndev);
1034
+		if (rc) {
1035
+			dev_warn(&pdev->dev,
1036
+				 "Failed to register MSI memory window: %d\n",
1037
+				 rc);
1038
+			nt->use_msi = false;
1039
+		}
1040
+	}
1041
+
1042
+	for (i = 0; i < nt->qp_count; i++)
1043
+		ntb_transport_setup_qp_msi(nt, i);
1044
+
8631045 	for (i = 0; i < nt->mw_count; i++) {
8641046 		size = nt->mw_vec[i].phys_size;
8651047 
....@@ -917,6 +1099,7 @@
9171099 		struct ntb_transport_qp *qp = &nt->qp_vec[i];
9181100 
9191101 		ntb_transport_setup_qp_mw(nt, i);
1102
+		ntb_transport_setup_qp_peer_msi(nt, i);
9201103 
9211104 		if (qp->client_ready)
9221105 			schedule_delayed_work(&qp->link_work, 0);
....@@ -1009,6 +1192,7 @@
10091192 	tx_size = (unsigned int)mw_size / num_qps_mw;
10101193 	qp_offset = tx_size * (qp_num / mw_count);
10111194 
1195
+	qp->tx_mw_size = tx_size;
10121196 	qp->tx_mw = nt->mw_vec[mw_num].vbase + qp_offset;
10131197 	if (!qp->tx_mw)
10141198 		return -EINVAL;
....@@ -1089,6 +1273,19 @@
10891273 		return -ENOMEM;
10901274 
10911275 	nt->ndev = ndev;
1276
+
1277
+	/*
1278
+	 * If we are using MSI, and have at least one extra memory window,
1279
+	 * we will reserve the last MW for the MSI window.
1280
+	 */
1281
+	if (use_msi && mw_count > 1) {
1282
+		rc = ntb_msi_init(ndev, ntb_transport_msi_desc_changed);
1283
+		if (!rc) {
1284
+			mw_count -= 1;
1285
+			nt->use_msi = true;
1286
+		}
1287
+	}
1288
+
10921289 	spad_count = ntb_spad_count(ndev);
10931290 
10941291 	/* Limit the MW's based on the availability of scratchpads */
....@@ -1101,6 +1298,8 @@
11011298 
11021299 	max_mw_count_for_spads = (spad_count - MW0_SZ_HIGH) / 2;
11031300 	nt->mw_count = min(mw_count, max_mw_count_for_spads);
1301
+
1302
+	nt->msi_spad_offset = nt->mw_count * 2 + MW0_SZ_HIGH;
11041303 
11051304 	nt->mw_vec = kcalloc_node(mw_count, sizeof(*nt->mw_vec),
11061305 				  GFP_KERNEL, node);
....@@ -1132,6 +1331,12 @@
11321331 	qp_bitmap = ntb_db_valid_mask(ndev);
11331332 
11341333 	qp_count = ilog2(qp_bitmap);
1334
+	if (nt->use_msi) {
1335
+		qp_count -= 1;
1336
+		nt->msi_db_mask = 1 << qp_count;
1337
+		ntb_db_clear_mask(ndev, nt->msi_db_mask);
1338
+	}
1339
+
11351340 	if (max_num_clients && max_num_clients < qp_count)
11361341 		qp_count = max_num_clients;
11371342 	else if (nt->mw_count < qp_count)
....@@ -1278,6 +1483,7 @@
12781483 		case DMA_TRANS_READ_FAILED:
12791484 		case DMA_TRANS_WRITE_FAILED:
12801485 			entry->errors++;
1486
+			fallthrough;
12811487 		case DMA_TRANS_ABORTED:
12821488 		{
12831489 			struct ntb_transport_qp *qp = entry->qp;
....@@ -1533,6 +1739,7 @@
15331739 		case DMA_TRANS_READ_FAILED:
15341740 		case DMA_TRANS_WRITE_FAILED:
15351741 			entry->errors++;
1742
+			fallthrough;
15361743 		case DMA_TRANS_ABORTED:
15371744 		{
15381745 			void __iomem *offset =
....@@ -1553,7 +1760,10 @@
15531760 
15541761 	iowrite32(entry->flags | DESC_DONE_FLAG, &hdr->flags);
15551762 
1556
-	ntb_peer_db_set(qp->ndev, BIT_ULL(qp->qp_num));
1763
+	if (qp->use_msi)
1764
+		ntb_msi_peer_trigger(qp->ndev, PIDX, &qp->peer_msi_desc);
1765
+	else
1766
+		ntb_peer_db_set(qp->ndev, BIT_ULL(qp->qp_num));
15571767 
15581768 	/* The entry length can only be zero if the packet is intended to be a
15591769 	 * "link down" or similar.  Since no payload is being sent in these
....@@ -1602,7 +1812,7 @@
16021812 	dma_cookie_t cookie;
16031813 
16041814 	device = chan->device;
1605
-	dest = qp->tx_mw_phys + qp->tx_max_frame * entry->tx_index;
1815
+	dest = qp->tx_mw_dma_addr + qp->tx_max_frame * entry->tx_index;
16061816 	buff_off = (size_t)buf & ~PAGE_MASK;
16071817 	dest_off = (size_t)dest & ~PAGE_MASK;
16081818 
....@@ -1821,6 +2031,19 @@
18212031 		qp->rx_dma_chan = NULL;
18222032 	}
18232033 
2034
+	qp->tx_mw_dma_addr = 0;
2035
+	if (qp->tx_dma_chan) {
2036
+		qp->tx_mw_dma_addr =
2037
+			dma_map_resource(qp->tx_dma_chan->device->dev,
2038
+					 qp->tx_mw_phys, qp->tx_mw_size,
2039
+					 DMA_FROM_DEVICE, 0);
2040
+		if (dma_mapping_error(qp->tx_dma_chan->device->dev,
2041
+				      qp->tx_mw_dma_addr)) {
2042
+			qp->tx_mw_dma_addr = 0;
2043
+			goto err1;
2044
+		}
2045
+	}
2046
+
18242047 	dev_dbg(&pdev->dev, "Using %s memcpy for TX\n",
18252048 		qp->tx_dma_chan ? "DMA" : "CPU");
18262049 
....@@ -1862,6 +2085,10 @@
18622085 	qp->rx_alloc_entry = 0;
18632086 	while ((entry = ntb_list_rm(&qp->ntb_rx_q_lock, &qp->rx_free_q)))
18642087 		kfree(entry);
2088
+	if (qp->tx_mw_dma_addr)
2089
+		dma_unmap_resource(qp->tx_dma_chan->device->dev,
2090
+				   qp->tx_mw_dma_addr, qp->tx_mw_size,
2091
+				   DMA_FROM_DEVICE, 0);
18652092 	if (qp->tx_dma_chan)
18662093 		dma_release_channel(qp->tx_dma_chan);
18672094 	if (qp->rx_dma_chan)
....@@ -1903,6 +2130,11 @@
19032130 		 */
19042131 		dma_sync_wait(chan, qp->last_cookie);
19052132 		dmaengine_terminate_all(chan);
2133
+
2134
+		dma_unmap_resource(chan->device->dev,
2135
+				   qp->tx_mw_dma_addr, qp->tx_mw_size,
2136
+				   DMA_FROM_DEVICE, 0);
2137
+
19062138 		dma_release_channel(chan);
19072139 	}
19082140 
....@@ -2199,6 +2431,11 @@
21992431 	u64 db_bits;
22002432 	unsigned int qp_num;
22012433 
2434
+	if (ntb_db_read(nt->ndev) & nt->msi_db_mask) {
2435
+		ntb_transport_msi_peer_desc_changed(nt);
2436
+		ntb_db_clear(nt->ndev, nt->msi_db_mask);
2437
+	}
2438
+
22022439 	db_bits = (nt->qp_bitmap & ~nt->qp_bitmap_free &
22032440 		   ntb_db_vector_mask(nt->ndev, vector));
22042441