|
@@ -130,6 +130,17 @@ static ssize_t firmware_loading_show(struct device *dev,
|
|
return sprintf(buf, "%d\n", loading);
|
|
return sprintf(buf, "%d\n", loading);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+static void firmware_free_data(const struct firmware *fw)
|
|
|
|
+{
|
|
|
|
+ int i;
|
|
|
|
+ vunmap(fw->data);
|
|
|
|
+ if (fw->pages) {
|
|
|
|
+ for (i = 0; i < PFN_UP(fw->size); i++)
|
|
|
|
+ __free_page(fw->pages[i]);
|
|
|
|
+ kfree(fw->pages);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
/* Some architectures don't have PAGE_KERNEL_RO */
|
|
/* Some architectures don't have PAGE_KERNEL_RO */
|
|
#ifndef PAGE_KERNEL_RO
|
|
#ifndef PAGE_KERNEL_RO
|
|
#define PAGE_KERNEL_RO PAGE_KERNEL
|
|
#define PAGE_KERNEL_RO PAGE_KERNEL
|
|
@@ -162,21 +173,21 @@ static ssize_t firmware_loading_store(struct device *dev,
|
|
mutex_unlock(&fw_lock);
|
|
mutex_unlock(&fw_lock);
|
|
break;
|
|
break;
|
|
}
|
|
}
|
|
- vfree(fw_priv->fw->data);
|
|
|
|
- fw_priv->fw->data = NULL;
|
|
|
|
|
|
+ firmware_free_data(fw_priv->fw);
|
|
|
|
+ memset(fw_priv->fw, 0, sizeof(struct firmware));
|
|
|
|
+ /* If the pages are not owned by 'struct firmware' */
|
|
for (i = 0; i < fw_priv->nr_pages; i++)
|
|
for (i = 0; i < fw_priv->nr_pages; i++)
|
|
__free_page(fw_priv->pages[i]);
|
|
__free_page(fw_priv->pages[i]);
|
|
kfree(fw_priv->pages);
|
|
kfree(fw_priv->pages);
|
|
fw_priv->pages = NULL;
|
|
fw_priv->pages = NULL;
|
|
fw_priv->page_array_size = 0;
|
|
fw_priv->page_array_size = 0;
|
|
fw_priv->nr_pages = 0;
|
|
fw_priv->nr_pages = 0;
|
|
- fw_priv->fw->size = 0;
|
|
|
|
set_bit(FW_STATUS_LOADING, &fw_priv->status);
|
|
set_bit(FW_STATUS_LOADING, &fw_priv->status);
|
|
mutex_unlock(&fw_lock);
|
|
mutex_unlock(&fw_lock);
|
|
break;
|
|
break;
|
|
case 0:
|
|
case 0:
|
|
if (test_bit(FW_STATUS_LOADING, &fw_priv->status)) {
|
|
if (test_bit(FW_STATUS_LOADING, &fw_priv->status)) {
|
|
- vfree(fw_priv->fw->data);
|
|
|
|
|
|
+ vunmap(fw_priv->fw->data);
|
|
fw_priv->fw->data = vmap(fw_priv->pages,
|
|
fw_priv->fw->data = vmap(fw_priv->pages,
|
|
fw_priv->nr_pages,
|
|
fw_priv->nr_pages,
|
|
0, PAGE_KERNEL_RO);
|
|
0, PAGE_KERNEL_RO);
|
|
@@ -184,7 +195,10 @@ static ssize_t firmware_loading_store(struct device *dev,
|
|
dev_err(dev, "%s: vmap() failed\n", __func__);
|
|
dev_err(dev, "%s: vmap() failed\n", __func__);
|
|
goto err;
|
|
goto err;
|
|
}
|
|
}
|
|
- /* Pages will be freed by vfree() */
|
|
|
|
|
|
+ /* Pages are now owned by 'struct firmware' */
|
|
|
|
+ fw_priv->fw->pages = fw_priv->pages;
|
|
|
|
+ fw_priv->pages = NULL;
|
|
|
|
+
|
|
fw_priv->page_array_size = 0;
|
|
fw_priv->page_array_size = 0;
|
|
fw_priv->nr_pages = 0;
|
|
fw_priv->nr_pages = 0;
|
|
complete(&fw_priv->completion);
|
|
complete(&fw_priv->completion);
|
|
@@ -578,7 +592,7 @@ release_firmware(const struct firmware *fw)
|
|
if (fw->data == builtin->data)
|
|
if (fw->data == builtin->data)
|
|
goto free_fw;
|
|
goto free_fw;
|
|
}
|
|
}
|
|
- vfree(fw->data);
|
|
|
|
|
|
+ firmware_free_data(fw);
|
|
free_fw:
|
|
free_fw:
|
|
kfree(fw);
|
|
kfree(fw);
|
|
}
|
|
}
|