GSMI driver uses dma_pool_* API functions for buffer allocation
because it requires that the SMI buffers are allocated within 32-bit
physical address space. However, this does not work well with IOMMU
since there is no real device and hence no domain associated with the
device.

Since this is not a real device, it does not require any device
address(IOVA) for the buffer allocations. The only requirement is to
ensure that the physical address allocated to the buffer is within
32-bit physical address space. This change allocates a page using
`get_zeroed_page()` and passes in GFP_DMA32 flag to ensure that the
page allocation is done in the DMA32 zone. All the buffer allocation
requests for gsmi_buf are then satisfed using this pre-allocated page
for the device.

In addition to that, all the code for managing the dma_pool for GSMI
platform device is dropped.

Signed-off-by: Furquan Shaikh <furq...@google.com>
Reviewed-by: Prashant Malani <pmal...@chromium.org>
---
 drivers/firmware/google/gsmi.c | 100 +++++++++++++++++++++++----------
 1 file changed, 71 insertions(+), 29 deletions(-)

diff --git a/drivers/firmware/google/gsmi.c b/drivers/firmware/google/gsmi.c
index 7d9367b22010..054c47346900 100644
--- a/drivers/firmware/google/gsmi.c
+++ b/drivers/firmware/google/gsmi.c
@@ -17,7 +17,6 @@
 #include <linux/string.h>
 #include <linux/spinlock.h>
 #include <linux/dma-mapping.h>
-#include <linux/dmapool.h>
 #include <linux/fs.h>
 #include <linux/slab.h>
 #include <linux/ioctl.h>
@@ -46,7 +45,6 @@
 #define DRIVER_VERSION         "1.0"
 #define GSMI_GUID_SIZE         16
 #define GSMI_BUF_SIZE          1024
-#define GSMI_BUF_ALIGN         sizeof(u64)
 #define GSMI_CALLBACK          0xef
 
 /* SMI return codes */
@@ -85,10 +83,15 @@
 struct gsmi_buf {
        u8 *start;                      /* start of buffer */
        size_t length;                  /* length of buffer */
-       dma_addr_t handle;              /* dma allocation handle */
        u32 address;                    /* physical address of buffer */
 };
 
+struct gsmi_page {
+       unsigned long base_address;     /* Base address of allocated page */
+       size_t alloc_size;              /* Size of allocation */
+       size_t alloc_used;              /* Amount of allocation that is used */
+};
+
 static struct gsmi_device {
        struct platform_device *pdev;   /* platform device */
        struct gsmi_buf *name_buf;      /* variable name buffer */
@@ -97,7 +100,7 @@ static struct gsmi_device {
        spinlock_t lock;                /* serialize access to SMIs */
        u16 smi_cmd;                    /* SMI command port */
        int handshake_type;             /* firmware handler interlock type */
-       struct dma_pool *dma_pool;      /* DMA buffer pool */
+       struct gsmi_page *page_info;    /* page allocated for GSMI buffers */
 } gsmi_dev;
 
 /* Packed structures for communicating with the firmware */
@@ -146,9 +149,57 @@ MODULE_PARM_DESC(spincount,
 static bool s0ix_logging_enable;
 module_param(s0ix_logging_enable, bool, 0600);
 
+static struct gsmi_page *gsmi_page_alloc(void)
+{
+       struct gsmi_page *page_info;
+
+       page_info = kzalloc(sizeof(*page_info), GFP_KERNEL);
+       if (!page_info) {
+               printk(KERN_ERR "gsmi: out of memory\n");
+               return NULL;
+       }
+
+       page_info->base_address = get_zeroed_page(GFP_KERNEL | GFP_DMA32);
+       if (!page_info->base_address) {
+               printk(KERN_ERR "gsmi: failed to allocate page for buffers\n");
+               return NULL;
+       }
+
+       /* Ensure the entire buffer is allocated within 32bit address space */
+       if (virt_to_phys((void *)(page_info->base_address + PAGE_SIZE - 1))
+           >> 32) {
+               printk(KERN_ERR "gsmi: allocation not within 32-bit physical 
address space\n");
+               free_page(page_info->base_address);
+               kfree(page_info);
+               return NULL;
+       }
+
+       page_info->alloc_size = PAGE_SIZE;
+
+       return page_info;
+}
+
+static unsigned long gsmi_page_allocate_buffer(void)
+{
+       struct gsmi_page *page_info = gsmi_dev.page_info;
+       unsigned long buf_offset = page_info->alloc_used;
+
+       if (buf_offset + GSMI_BUF_SIZE > page_info->alloc_size) {
+               printk(KERN_ERR "gsmi: out of space for buffer allocation\n");
+               return 0;
+       }
+
+       page_info->alloc_used = buf_offset + GSMI_BUF_SIZE;
+       return page_info->base_address + buf_offset;
+}
+
 static struct gsmi_buf *gsmi_buf_alloc(void)
 {
        struct gsmi_buf *smibuf;
+       u8 *buf_addr = (u8 *)gsmi_page_allocate_buffer();
+
+       if (!buf_addr)
+               return NULL;
 
        smibuf = kzalloc(sizeof(*smibuf), GFP_KERNEL);
        if (!smibuf) {
@@ -156,14 +207,7 @@ static struct gsmi_buf *gsmi_buf_alloc(void)
                return NULL;
        }
 
-       /* allocate buffer in 32bit address space */
-       smibuf->start = dma_pool_alloc(gsmi_dev.dma_pool, GFP_KERNEL,
-                                      &smibuf->handle);
-       if (!smibuf->start) {
-               printk(KERN_ERR "gsmi: failed to allocate name buffer\n");
-               kfree(smibuf);
-               return NULL;
-       }
+       smibuf->start = buf_addr;
 
        /* fill in the buffer handle */
        smibuf->length = GSMI_BUF_SIZE;
@@ -172,13 +216,15 @@ static struct gsmi_buf *gsmi_buf_alloc(void)
        return smibuf;
 }
 
-static void gsmi_buf_free(struct gsmi_buf *smibuf)
+static void gsmi_free_alloc(void)
 {
-       if (smibuf) {
-               if (smibuf->start)
-                       dma_pool_free(gsmi_dev.dma_pool, smibuf->start,
-                                     smibuf->handle);
-               kfree(smibuf);
+       kfree(gsmi_dev.param_buf);
+       kfree(gsmi_dev.data_buf);
+       kfree(gsmi_dev.name_buf);
+
+       if (gsmi_dev.page_info) {
+               free_page(gsmi_dev.page_info->base_address);
+               kfree(gsmi_dev.page_info);
        }
 }
 
@@ -914,10 +960,12 @@ static __init int gsmi_init(void)
        spin_lock_init(&gsmi_dev.lock);
 
        ret = -ENOMEM;
-       gsmi_dev.dma_pool = dma_pool_create("gsmi", &gsmi_dev.pdev->dev,
-                                            GSMI_BUF_SIZE, GSMI_BUF_ALIGN, 0);
-       if (!gsmi_dev.dma_pool)
+
+       gsmi_dev.page_info = gsmi_page_alloc();
+       if (!gsmi_dev.page_info) {
+               printk(KERN_ERR "gsmi: failed to allocate page\n");
                goto out_err;
+       }
 
        /*
         * pre-allocate buffers because sometimes we are called when
@@ -1029,10 +1077,7 @@ static __init int gsmi_init(void)
        sysfs_remove_bin_file(gsmi_kobj, &eventlog_bin_attr);
 out_err:
        kobject_put(gsmi_kobj);
-       gsmi_buf_free(gsmi_dev.param_buf);
-       gsmi_buf_free(gsmi_dev.data_buf);
-       gsmi_buf_free(gsmi_dev.name_buf);
-       dma_pool_destroy(gsmi_dev.dma_pool);
+       gsmi_free_alloc();
        platform_device_unregister(gsmi_dev.pdev);
        pr_info("gsmi: failed to load: %d\n", ret);
 #ifdef CONFIG_PM
@@ -1054,10 +1099,7 @@ static void __exit gsmi_exit(void)
        sysfs_remove_files(gsmi_kobj, gsmi_attrs);
        sysfs_remove_bin_file(gsmi_kobj, &eventlog_bin_attr);
        kobject_put(gsmi_kobj);
-       gsmi_buf_free(gsmi_dev.param_buf);
-       gsmi_buf_free(gsmi_dev.data_buf);
-       gsmi_buf_free(gsmi_dev.name_buf);
-       dma_pool_destroy(gsmi_dev.dma_pool);
+       gsmi_free_alloc();
        platform_device_unregister(gsmi_dev.pdev);
 #ifdef CONFIG_PM
        platform_driver_unregister(&gsmi_driver_info);
-- 
2.29.0.rc1.297.gfa9743e501-goog

Reply via email to