Commit ee4ddad8 authored by Markus Elfring's avatar Markus Elfring Committed by Kalle Valo

cw1200: Less function calls in cw1200_load_firmware_cw1200() after error detection

The functions kfree() and release_firmware() were called in a few cases
by the cw1200_load_firmware_cw1200() function during error handling even if
the passed variables contained still a null pointer.

Corresponding implementation details could be improved by adjustments for
jump targets.
Signed-off-by: default avatarMarkus Elfring <elfring@users.sourceforge.net>
Signed-off-by: default avatarKalle Valo <kvalo@codeaurora.org>
parent df970d39
...@@ -66,25 +66,31 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -66,25 +66,31 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
do { \ do { \
ret = cw1200_apb_write_32(priv, CW1200_APB(reg), (val)); \ ret = cw1200_apb_write_32(priv, CW1200_APB(reg), (val)); \
if (ret < 0) \ if (ret < 0) \
goto error; \ goto exit; \
} while (0)
#define APB_WRITE2(reg, val) \
do { \
ret = cw1200_apb_write_32(priv, CW1200_APB(reg), (val)); \
if (ret < 0) \
goto free_buffer; \
} while (0) } while (0)
#define APB_READ(reg, val) \ #define APB_READ(reg, val) \
do { \ do { \
ret = cw1200_apb_read_32(priv, CW1200_APB(reg), &(val)); \ ret = cw1200_apb_read_32(priv, CW1200_APB(reg), &(val)); \
if (ret < 0) \ if (ret < 0) \
goto error; \ goto free_buffer; \
} while (0) } while (0)
#define REG_WRITE(reg, val) \ #define REG_WRITE(reg, val) \
do { \ do { \
ret = cw1200_reg_write_32(priv, (reg), (val)); \ ret = cw1200_reg_write_32(priv, (reg), (val)); \
if (ret < 0) \ if (ret < 0) \
goto error; \ goto exit; \
} while (0) } while (0)
#define REG_READ(reg, val) \ #define REG_READ(reg, val) \
do { \ do { \
ret = cw1200_reg_read_32(priv, (reg), &(val)); \ ret = cw1200_reg_read_32(priv, (reg), &(val)); \
if (ret < 0) \ if (ret < 0) \
goto error; \ goto exit; \
} while (0) } while (0)
switch (priv->hw_revision) { switch (priv->hw_revision) {
...@@ -142,14 +148,14 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -142,14 +148,14 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
ret = request_firmware(&firmware, fw_path, priv->pdev); ret = request_firmware(&firmware, fw_path, priv->pdev);
if (ret) { if (ret) {
pr_err("Can't load firmware file %s.\n", fw_path); pr_err("Can't load firmware file %s.\n", fw_path);
goto error; goto exit;
} }
buf = kmalloc(DOWNLOAD_BLOCK_SIZE, GFP_KERNEL | GFP_DMA); buf = kmalloc(DOWNLOAD_BLOCK_SIZE, GFP_KERNEL | GFP_DMA);
if (!buf) { if (!buf) {
pr_err("Can't allocate firmware load buffer.\n"); pr_err("Can't allocate firmware load buffer.\n");
ret = -ENOMEM; ret = -ENOMEM;
goto error; goto firmware_release;
} }
/* Check if the bootloader is ready */ /* Check if the bootloader is ready */
...@@ -163,7 +169,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -163,7 +169,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
if (val32 != DOWNLOAD_I_AM_HERE) { if (val32 != DOWNLOAD_I_AM_HERE) {
pr_err("Bootloader is not ready.\n"); pr_err("Bootloader is not ready.\n");
ret = -ETIMEDOUT; ret = -ETIMEDOUT;
goto error; goto free_buffer;
} }
/* Calculcate number of download blocks */ /* Calculcate number of download blocks */
...@@ -171,7 +177,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -171,7 +177,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
/* Updating the length in Download Ctrl Area */ /* Updating the length in Download Ctrl Area */
val32 = firmware->size; /* Explicit cast from size_t to u32 */ val32 = firmware->size; /* Explicit cast from size_t to u32 */
APB_WRITE(DOWNLOAD_IMAGE_SIZE_REG, val32); APB_WRITE2(DOWNLOAD_IMAGE_SIZE_REG, val32);
/* Firmware downloading loop */ /* Firmware downloading loop */
for (block = 0; block < num_blocks; block++) { for (block = 0; block < num_blocks; block++) {
...@@ -183,7 +189,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -183,7 +189,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
if (val32 != DOWNLOAD_PENDING) { if (val32 != DOWNLOAD_PENDING) {
pr_err("Bootloader reported error %d.\n", val32); pr_err("Bootloader reported error %d.\n", val32);
ret = -EIO; ret = -EIO;
goto error; goto free_buffer;
} }
/* loop until put - get <= 24K */ /* loop until put - get <= 24K */
...@@ -198,7 +204,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -198,7 +204,7 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
if ((put - get) > (DOWNLOAD_FIFO_SIZE - DOWNLOAD_BLOCK_SIZE)) { if ((put - get) > (DOWNLOAD_FIFO_SIZE - DOWNLOAD_BLOCK_SIZE)) {
pr_err("Timeout waiting for FIFO.\n"); pr_err("Timeout waiting for FIFO.\n");
ret = -ETIMEDOUT; ret = -ETIMEDOUT;
goto error; goto free_buffer;
} }
/* calculate the block size */ /* calculate the block size */
...@@ -220,12 +226,12 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -220,12 +226,12 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
if (ret < 0) { if (ret < 0) {
pr_err("Can't write firmware block @ %d!\n", pr_err("Can't write firmware block @ %d!\n",
put & (DOWNLOAD_FIFO_SIZE - 1)); put & (DOWNLOAD_FIFO_SIZE - 1));
goto error; goto free_buffer;
} }
/* update the put register */ /* update the put register */
put += block_size; put += block_size;
APB_WRITE(DOWNLOAD_PUT_REG, put); APB_WRITE2(DOWNLOAD_PUT_REG, put);
} /* End of firmware download loop */ } /* End of firmware download loop */
/* Wait for the download completion */ /* Wait for the download completion */
...@@ -238,18 +244,21 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv) ...@@ -238,18 +244,21 @@ static int cw1200_load_firmware_cw1200(struct cw1200_common *priv)
if (val32 != DOWNLOAD_SUCCESS) { if (val32 != DOWNLOAD_SUCCESS) {
pr_err("Wait for download completion failed: 0x%.8X\n", val32); pr_err("Wait for download completion failed: 0x%.8X\n", val32);
ret = -ETIMEDOUT; ret = -ETIMEDOUT;
goto error; goto free_buffer;
} else { } else {
pr_info("Firmware download completed.\n"); pr_info("Firmware download completed.\n");
ret = 0; ret = 0;
} }
error: free_buffer:
kfree(buf); kfree(buf);
firmware_release:
release_firmware(firmware); release_firmware(firmware);
exit:
return ret; return ret;
#undef APB_WRITE #undef APB_WRITE
#undef APB_WRITE2
#undef APB_READ #undef APB_READ
#undef REG_WRITE #undef REG_WRITE
#undef REG_READ #undef REG_READ
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment