196 lines · c
1// SPDX-License-Identifier: ISC2/*3 * Copyright (c) 2015-2016 Qualcomm Atheros, Inc.4 */5 6/* This file has implementation for code swap logic. With code swap feature,7 * target can run the fw binary with even smaller IRAM size by using host8 * memory to store some of the code segments.9 */10 11#include "core.h"12#include "bmi.h"13#include "debug.h"14 15static int ath10k_swap_code_seg_fill(struct ath10k *ar,16 struct ath10k_swap_code_seg_info *seg_info,17 const void *data, size_t data_len)18{19 u8 *virt_addr = seg_info->virt_address[0];20 u8 swap_magic[ATH10K_SWAP_CODE_SEG_MAGIC_BYTES_SZ] = {};21 const u8 *fw_data = data;22 union ath10k_swap_code_seg_item *swap_item;23 u32 length = 0;24 u32 payload_len;25 u32 total_payload_len = 0;26 u32 size_left = data_len;27 28 /* Parse swap bin and copy the content to host allocated memory.29 * The format is Address, length and value. The last 4-bytes is30 * target write address. Currently address field is not used.31 */32 seg_info->target_addr = -1;33 while (size_left >= sizeof(*swap_item)) {34 swap_item = (union ath10k_swap_code_seg_item *)fw_data;35 payload_len = __le32_to_cpu(swap_item->tlv.length);36 if ((payload_len > size_left) ||37 (payload_len == 0 &&38 size_left != sizeof(struct ath10k_swap_code_seg_tail))) {39 ath10k_err(ar, "refusing to parse invalid tlv length %d\n",40 payload_len);41 return -EINVAL;42 }43 44 if (payload_len == 0) {45 if (memcmp(swap_item->tail.magic_signature, swap_magic,46 ATH10K_SWAP_CODE_SEG_MAGIC_BYTES_SZ)) {47 ath10k_err(ar, "refusing an invalid swap file\n");48 return -EINVAL;49 }50 seg_info->target_addr =51 __le32_to_cpu(swap_item->tail.bmi_write_addr);52 break;53 }54 55 memcpy(virt_addr, swap_item->tlv.data, payload_len);56 virt_addr += payload_len;57 length = payload_len + sizeof(struct ath10k_swap_code_seg_tlv);58 size_left -= length;59 fw_data += length;60 total_payload_len += payload_len;61 }62 63 if (seg_info->target_addr == -1) {64 ath10k_err(ar, "failed to parse invalid swap file\n");65 return -EINVAL;66 }67 seg_info->seg_hw_info.swap_size = __cpu_to_le32(total_payload_len);68 69 return 0;70}71 72static void73ath10k_swap_code_seg_free(struct ath10k *ar,74 struct ath10k_swap_code_seg_info *seg_info)75{76 u32 seg_size;77 78 if (!seg_info)79 return;80 81 if (!seg_info->virt_address[0])82 return;83 84 seg_size = __le32_to_cpu(seg_info->seg_hw_info.size);85 dma_free_coherent(ar->dev, seg_size, seg_info->virt_address[0],86 seg_info->paddr[0]);87}88 89static struct ath10k_swap_code_seg_info *90ath10k_swap_code_seg_alloc(struct ath10k *ar, size_t swap_bin_len)91{92 struct ath10k_swap_code_seg_info *seg_info;93 void *virt_addr;94 dma_addr_t paddr;95 96 swap_bin_len = roundup(swap_bin_len, 2);97 if (swap_bin_len > ATH10K_SWAP_CODE_SEG_BIN_LEN_MAX) {98 ath10k_err(ar, "refusing code swap bin because it is too big %zu > %d\n",99 swap_bin_len, ATH10K_SWAP_CODE_SEG_BIN_LEN_MAX);100 return NULL;101 }102 103 seg_info = devm_kzalloc(ar->dev, sizeof(*seg_info), GFP_KERNEL);104 if (!seg_info)105 return NULL;106 107 virt_addr = dma_alloc_coherent(ar->dev, swap_bin_len, &paddr,108 GFP_KERNEL);109 if (!virt_addr)110 return NULL;111 112 seg_info->seg_hw_info.bus_addr[0] = __cpu_to_le32(paddr);113 seg_info->seg_hw_info.size = __cpu_to_le32(swap_bin_len);114 seg_info->seg_hw_info.swap_size = __cpu_to_le32(swap_bin_len);115 seg_info->seg_hw_info.num_segs =116 __cpu_to_le32(ATH10K_SWAP_CODE_SEG_NUM_SUPPORTED);117 seg_info->seg_hw_info.size_log2 = __cpu_to_le32(ilog2(swap_bin_len));118 seg_info->virt_address[0] = virt_addr;119 seg_info->paddr[0] = paddr;120 121 return seg_info;122}123 124int ath10k_swap_code_seg_configure(struct ath10k *ar,125 const struct ath10k_fw_file *fw_file)126{127 int ret;128 struct ath10k_swap_code_seg_info *seg_info = NULL;129 130 if (!fw_file->firmware_swap_code_seg_info)131 return 0;132 133 ath10k_dbg(ar, ATH10K_DBG_BOOT, "boot found firmware code swap binary\n");134 135 seg_info = fw_file->firmware_swap_code_seg_info;136 137 ret = ath10k_bmi_write_memory(ar, seg_info->target_addr,138 &seg_info->seg_hw_info,139 sizeof(seg_info->seg_hw_info));140 if (ret) {141 ath10k_err(ar, "failed to write Code swap segment information (%d)\n",142 ret);143 return ret;144 }145 146 return 0;147}148 149void ath10k_swap_code_seg_release(struct ath10k *ar,150 struct ath10k_fw_file *fw_file)151{152 ath10k_swap_code_seg_free(ar, fw_file->firmware_swap_code_seg_info);153 154 /* FIXME: these two assignments look to bein wrong place! Shouldn't155 * they be in ath10k_core_free_firmware_files() like the rest?156 */157 fw_file->codeswap_data = NULL;158 fw_file->codeswap_len = 0;159 160 fw_file->firmware_swap_code_seg_info = NULL;161}162 163int ath10k_swap_code_seg_init(struct ath10k *ar, struct ath10k_fw_file *fw_file)164{165 int ret;166 struct ath10k_swap_code_seg_info *seg_info;167 const void *codeswap_data;168 size_t codeswap_len;169 170 codeswap_data = fw_file->codeswap_data;171 codeswap_len = fw_file->codeswap_len;172 173 if (!codeswap_len || !codeswap_data)174 return 0;175 176 seg_info = ath10k_swap_code_seg_alloc(ar, codeswap_len);177 if (!seg_info) {178 ath10k_err(ar, "failed to allocate fw code swap segment\n");179 return -ENOMEM;180 }181 182 ret = ath10k_swap_code_seg_fill(ar, seg_info,183 codeswap_data, codeswap_len);184 185 if (ret) {186 ath10k_warn(ar, "failed to initialize fw code swap segment: %d\n",187 ret);188 ath10k_swap_code_seg_free(ar, seg_info);189 return ret;190 }191 192 fw_file->firmware_swap_code_seg_info = seg_info;193 194 return 0;195}196