3  * Host side test driver to test endpoint functionality
28 #define DRV_MODULE_NAME				"pci-endpoint-test"
127 static inline u32 pci_endpoint_test_readl(struct pci_endpoint_test *test,  in pci_endpoint_test_readl()  argument
130 	return readl(test->base + offset);  in pci_endpoint_test_readl()
133 static inline void pci_endpoint_test_writel(struct pci_endpoint_test *test,  in pci_endpoint_test_writel()  argument
136 	writel(value, test->base + offset);  in pci_endpoint_test_writel()
139 static inline u32 pci_endpoint_test_bar_readl(struct pci_endpoint_test *test,  in pci_endpoint_test_bar_readl()  argument
142 	return readl(test->bar[bar] + offset);  in pci_endpoint_test_bar_readl()
145 static inline void pci_endpoint_test_bar_writel(struct pci_endpoint_test *test,  in pci_endpoint_test_bar_writel()  argument
148 	writel(value, test->bar[bar] + offset);  in pci_endpoint_test_bar_writel()
153 	struct pci_endpoint_test *test = dev_id;  in pci_endpoint_test_irqhandler()  local
156 	reg = pci_endpoint_test_readl(test, PCI_ENDPOINT_TEST_STATUS);  in pci_endpoint_test_irqhandler()
158 		test->last_irq = irq;  in pci_endpoint_test_irqhandler()
159 		complete(&test->irq_raised);  in pci_endpoint_test_irqhandler()
162 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_STATUS,  in pci_endpoint_test_irqhandler()
168 static void pci_endpoint_test_free_irq_vectors(struct pci_endpoint_test *test)  in pci_endpoint_test_free_irq_vectors()  argument
170 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_free_irq_vectors()
173 	test->irq_type = IRQ_TYPE_UNDEFINED;  in pci_endpoint_test_free_irq_vectors()
176 static bool pci_endpoint_test_alloc_irq_vectors(struct pci_endpoint_test *test,  in pci_endpoint_test_alloc_irq_vectors()  argument
180 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_alloc_irq_vectors()
209 	test->irq_type = type;  in pci_endpoint_test_alloc_irq_vectors()
210 	test->num_irqs = irq;  in pci_endpoint_test_alloc_irq_vectors()
215 static void pci_endpoint_test_release_irq(struct pci_endpoint_test *test)  in pci_endpoint_test_release_irq()  argument
218 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_release_irq()
221 	for (i = 0; i < test->num_irqs; i++)  in pci_endpoint_test_release_irq()
222 		devm_free_irq(dev, pci_irq_vector(pdev, i), test);  in pci_endpoint_test_release_irq()
224 	test->num_irqs = 0;  in pci_endpoint_test_release_irq()
227 static bool pci_endpoint_test_request_irq(struct pci_endpoint_test *test)  in pci_endpoint_test_request_irq()  argument
231 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_request_irq()
234 	for (i = 0; i < test->num_irqs; i++) {  in pci_endpoint_test_request_irq()
237 				       IRQF_SHARED, test->name, test);  in pci_endpoint_test_request_irq()
265 static bool pci_endpoint_test_bar(struct pci_endpoint_test *test,  in pci_endpoint_test_bar()  argument
271 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_bar()
273 	if (!test->bar[barno])  in pci_endpoint_test_bar()
278 	if (barno == test->test_reg_bar)  in pci_endpoint_test_bar()
282 		pci_endpoint_test_bar_writel(test, barno, j, 0xA0A0A0A0);  in pci_endpoint_test_bar()
285 		val = pci_endpoint_test_bar_readl(test, barno, j);  in pci_endpoint_test_bar()
293 static bool pci_endpoint_test_legacy_irq(struct pci_endpoint_test *test)  in pci_endpoint_test_legacy_irq()  argument
297 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_TYPE,  in pci_endpoint_test_legacy_irq()
299 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_NUMBER, 0);  in pci_endpoint_test_legacy_irq()
300 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_COMMAND,  in pci_endpoint_test_legacy_irq()
302 	val = wait_for_completion_timeout(&test->irq_raised,  in pci_endpoint_test_legacy_irq()
310 static bool pci_endpoint_test_msi_irq(struct pci_endpoint_test *test,  in pci_endpoint_test_msi_irq()  argument
314 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_msi_irq()
316 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_TYPE,  in pci_endpoint_test_msi_irq()
319 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_NUMBER, msi_num);  in pci_endpoint_test_msi_irq()
320 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_COMMAND,  in pci_endpoint_test_msi_irq()
323 	val = wait_for_completion_timeout(&test->irq_raised,  in pci_endpoint_test_msi_irq()
328 	if (pci_irq_vector(pdev, msi_num - 1) == test->last_irq)  in pci_endpoint_test_msi_irq()
350 static bool pci_endpoint_test_copy(struct pci_endpoint_test *test,  in pci_endpoint_test_copy()  argument
362 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_copy()
369 	size_t alignment = test->alignment;  in pci_endpoint_test_copy()
370 	int irq_type = test->irq_type;  in pci_endpoint_test_copy()
421 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_LOWER_SRC_ADDR,  in pci_endpoint_test_copy()
424 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_UPPER_SRC_ADDR,  in pci_endpoint_test_copy()
453 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_LOWER_DST_ADDR,  in pci_endpoint_test_copy()
455 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_UPPER_DST_ADDR,  in pci_endpoint_test_copy()
458 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_SIZE,  in pci_endpoint_test_copy()
461 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_FLAGS, flags);  in pci_endpoint_test_copy()
462 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_TYPE, irq_type);  in pci_endpoint_test_copy()
463 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_NUMBER, 1);  in pci_endpoint_test_copy()
464 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_COMMAND,  in pci_endpoint_test_copy()
467 	wait_for_completion(&test->irq_raised);  in pci_endpoint_test_copy()
490 static bool pci_endpoint_test_write(struct pci_endpoint_test *test,  in pci_endpoint_test_write()  argument
500 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_write()
505 	size_t alignment = test->alignment;  in pci_endpoint_test_write()
506 	int irq_type = test->irq_type;  in pci_endpoint_test_write()
559 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_CHECKSUM,  in pci_endpoint_test_write()
562 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_LOWER_SRC_ADDR,  in pci_endpoint_test_write()
564 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_UPPER_SRC_ADDR,  in pci_endpoint_test_write()
567 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_SIZE, size);  in pci_endpoint_test_write()
569 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_FLAGS, flags);  in pci_endpoint_test_write()
570 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_TYPE, irq_type);  in pci_endpoint_test_write()
571 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_NUMBER, 1);  in pci_endpoint_test_write()
572 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_COMMAND,  in pci_endpoint_test_write()
575 	wait_for_completion(&test->irq_raised);  in pci_endpoint_test_write()
577 	reg = pci_endpoint_test_readl(test, PCI_ENDPOINT_TEST_STATUS);  in pci_endpoint_test_write()
591 static bool pci_endpoint_test_read(struct pci_endpoint_test *test,  in pci_endpoint_test_read()  argument
601 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_read()
606 	size_t alignment = test->alignment;  in pci_endpoint_test_read()
607 	int irq_type = test->irq_type;  in pci_endpoint_test_read()
656 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_LOWER_DST_ADDR,  in pci_endpoint_test_read()
658 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_UPPER_DST_ADDR,  in pci_endpoint_test_read()
661 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_SIZE, size);  in pci_endpoint_test_read()
663 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_FLAGS, flags);  in pci_endpoint_test_read()
664 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_TYPE, irq_type);  in pci_endpoint_test_read()
665 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_IRQ_NUMBER, 1);  in pci_endpoint_test_read()
666 	pci_endpoint_test_writel(test, PCI_ENDPOINT_TEST_COMMAND,  in pci_endpoint_test_read()
669 	wait_for_completion(&test->irq_raised);  in pci_endpoint_test_read()
675 	if (crc32 == pci_endpoint_test_readl(test, PCI_ENDPOINT_TEST_CHECKSUM))  in pci_endpoint_test_read()
684 static bool pci_endpoint_test_clear_irq(struct pci_endpoint_test *test)  in pci_endpoint_test_clear_irq()  argument
686 	pci_endpoint_test_release_irq(test);  in pci_endpoint_test_clear_irq()
687 	pci_endpoint_test_free_irq_vectors(test);  in pci_endpoint_test_clear_irq()
691 static bool pci_endpoint_test_set_irq(struct pci_endpoint_test *test,  in pci_endpoint_test_set_irq()  argument
694 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_set_irq()
702 	if (test->irq_type == req_irq_type)  in pci_endpoint_test_set_irq()
705 	pci_endpoint_test_release_irq(test);  in pci_endpoint_test_set_irq()
706 	pci_endpoint_test_free_irq_vectors(test);  in pci_endpoint_test_set_irq()
708 	if (!pci_endpoint_test_alloc_irq_vectors(test, req_irq_type))  in pci_endpoint_test_set_irq()
711 	if (!pci_endpoint_test_request_irq(test))  in pci_endpoint_test_set_irq()
717 	pci_endpoint_test_free_irq_vectors(test);  in pci_endpoint_test_set_irq()
726 	struct pci_endpoint_test *test = to_endpoint_test(file->private_data);  in pci_endpoint_test_ioctl()  local
727 	struct pci_dev *pdev = test->pdev;  in pci_endpoint_test_ioctl()
729 	mutex_lock(&test->mutex);  in pci_endpoint_test_ioctl()
737 		ret = pci_endpoint_test_bar(test, bar);  in pci_endpoint_test_ioctl()
740 		ret = pci_endpoint_test_legacy_irq(test);  in pci_endpoint_test_ioctl()
744 		ret = pci_endpoint_test_msi_irq(test, arg, cmd == PCITEST_MSIX);  in pci_endpoint_test_ioctl()
747 		ret = pci_endpoint_test_write(test, arg);  in pci_endpoint_test_ioctl()
750 		ret = pci_endpoint_test_read(test, arg);  in pci_endpoint_test_ioctl()
753 		ret = pci_endpoint_test_copy(test, arg);  in pci_endpoint_test_ioctl()
756 		ret = pci_endpoint_test_set_irq(test, arg);  in pci_endpoint_test_ioctl()
762 		ret = pci_endpoint_test_clear_irq(test);  in pci_endpoint_test_ioctl()
767 	mutex_unlock(&test->mutex);  in pci_endpoint_test_ioctl()
785 	struct pci_endpoint_test *test;  in pci_endpoint_test_probe()  local
793 	test = devm_kzalloc(dev, sizeof(*test), GFP_KERNEL);  in pci_endpoint_test_probe()
794 	if (!test)  in pci_endpoint_test_probe()
797 	test->test_reg_bar = 0;  in pci_endpoint_test_probe()
798 	test->alignment = 0;  in pci_endpoint_test_probe()
799 	test->pdev = pdev;  in pci_endpoint_test_probe()
800 	test->irq_type = IRQ_TYPE_UNDEFINED;  in pci_endpoint_test_probe()
808 		test->test_reg_bar = test_reg_bar;  in pci_endpoint_test_probe()
809 		test->alignment = data->alignment;  in pci_endpoint_test_probe()
813 	init_completion(&test->irq_raised);  in pci_endpoint_test_probe()
814 	mutex_init(&test->mutex);  in pci_endpoint_test_probe()
836 	if (!pci_endpoint_test_alloc_irq_vectors(test, irq_type)) {  in pci_endpoint_test_probe()
848 			test->bar[bar] = base;  in pci_endpoint_test_probe()
852 	test->base = test->bar[test_reg_bar];  in pci_endpoint_test_probe()
853 	if (!test->base) {  in pci_endpoint_test_probe()
855 		dev_err(dev, "Cannot perform PCI test without BAR%d\n",  in pci_endpoint_test_probe()
860 	pci_set_drvdata(pdev, test);  in pci_endpoint_test_probe()
870 	test->name = kstrdup(name, GFP_KERNEL);  in pci_endpoint_test_probe()
871 	if (!test->name) {  in pci_endpoint_test_probe()
876 	if (!pci_endpoint_test_request_irq(test)) {  in pci_endpoint_test_probe()
881 	misc_device = &test->miscdev;  in pci_endpoint_test_probe()
902 	pci_endpoint_test_release_irq(test);  in pci_endpoint_test_probe()
905 	kfree(test->name);  in pci_endpoint_test_probe()
912 		if (test->bar[bar])  in pci_endpoint_test_probe()
913 			pci_iounmap(pdev, test->bar[bar]);  in pci_endpoint_test_probe()
917 	pci_endpoint_test_free_irq_vectors(test);  in pci_endpoint_test_probe()
930 	struct pci_endpoint_test *test = pci_get_drvdata(pdev);  in pci_endpoint_test_remove()  local
931 	struct miscdevice *misc_device = &test->miscdev;  in pci_endpoint_test_remove()
938 	misc_deregister(&test->miscdev);  in pci_endpoint_test_remove()
940 	kfree(test->name);  in pci_endpoint_test_remove()
943 		if (test->bar[bar])  in pci_endpoint_test_remove()
944 			pci_iounmap(pdev, test->bar[bar]);  in pci_endpoint_test_remove()
947 	pci_endpoint_test_release_irq(test);  in pci_endpoint_test_remove()
948 	pci_endpoint_test_free_irq_vectors(test);  in pci_endpoint_test_remove()
1007 MODULE_DESCRIPTION("PCI ENDPOINT TEST HOST DRIVER");