[igt-dev] [PATCH i-g-t v2 2/3] lib/igt_device: add igt_map_bar_region

[Daniel Mrzyglod]

This function use sysfs to map particular mmio region.

Signed-off-by: Daniel Mrzyglod <daniel.t.mrzyglod at intel.com>
---
 lib/igt_device.c | 38 ++++++++++++++++++++++++++++++++++++--
 lib/igt_device.h |  1 +
 2 files changed, 37 insertions(+), 2 deletions(-)

diff --git a/lib/igt_device.c b/lib/igt_device.c
index f3d2a9f5..9dec6106 100644
--- a/lib/igt_device.c
+++ b/lib/igt_device.c
@@ -148,11 +148,9 @@ static int igt_device_get_pci_addr(int fd, struct igt_pci_addr *pci)
 
 	if (!igt_device_is_pci(fd))
 		return -ENODEV;
-
 	sysfs = igt_sysfs_open(fd);
 	if (sysfs == -1)
 		return -ENOENT;
-
 	len = readlinkat(sysfs, "device", path, sizeof(path) - 1);
 	if (len == -1)
 		return -ENOENT;
@@ -225,3 +223,39 @@ struct pci_device *igt_device_get_pci_device(int fd)
 
 	return pci_dev;
 }
+
+/**
+ * igt_device_map_pci_bar_region:
+ *
+ * @fd: the device
+ * @mmio_bar: bar to be mapped
+ * @mmio_size: bar size
+ *
+ * Returns:
+ * The pointer for mmapped bar
+ */
+void *igt_device_map_pci_bar_region(int fd, int  mmio_bar, int mmio_size)
+{
+	struct igt_pci_addr pci_addr;
+	char *filepath = NULL;
+	int newfd;
+	void *igt_mmio = NULL;
+	if (igt_device_get_pci_addr(fd, &pci_addr)) {
+		igt_warn("Unable to find device PCI address\n");
+		return NULL;
+	}
+
+	asprintf(&filepath, "/sys/devices/pci%.4x:%.2x/%.4x:%.2x:%.2x.%.1x/resource%.1x",
+		 pci_addr.domain, pci_addr.bus, pci_addr.domain, pci_addr.bus,
+		 pci_addr.device, pci_addr.function, mmio_bar);
+
+	newfd = open(filepath, O_RDWR | O_SYNC);
+	igt_mmio = mmap(0, mmio_size, PROT_READ | PROT_WRITE, MAP_SHARED, newfd, 0);
+	free(filepath);
+	close(newfd);
+
+	igt_fail_on_f(igt_mmio == MAP_FAILED,
+		      "Couldn't map MMIO region\n");
+
+	return igt_mmio;
+}
diff --git a/lib/igt_device.h b/lib/igt_device.h
index 860b3a8a..6ffc1d5e 100644
--- a/lib/igt_device.h
+++ b/lib/igt_device.h
@@ -34,5 +34,6 @@ void igt_device_drop_master(int fd);
 
 int igt_device_get_card_index(int fd);
 struct pci_device *igt_device_get_pci_device(int fd);
+void *igt_device_map_pci_bar_region(int fd, int  mmio_bar, int mmio_size);
 
 #endif /* __IGT_DEVICE_H__ */
-- 
2.20.1