Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2005-2011 Atheros Communications Inc. |
| 3 | * Copyright (c) 2011-2013 Qualcomm Atheros, Inc. |
| 4 | * |
| 5 | * Permission to use, copy, modify, and/or distribute this software for any |
| 6 | * purpose with or without fee is hereby granted, provided that the above |
| 7 | * copyright notice and this permission notice appear in all copies. |
| 8 | * |
| 9 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| 10 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| 11 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| 12 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| 13 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| 14 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
| 15 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 16 | */ |
| 17 | |
| 18 | #include "bmi.h" |
| 19 | #include "hif.h" |
| 20 | #include "debug.h" |
| 21 | #include "htc.h" |
| 22 | |
Michal Kazior | 64d151d | 2013-07-16 09:38:53 +0200 | [diff] [blame] | 23 | void ath10k_bmi_start(struct ath10k *ar) |
| 24 | { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 25 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi start\n"); |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 26 | |
Michal Kazior | 64d151d | 2013-07-16 09:38:53 +0200 | [diff] [blame] | 27 | ar->bmi.done_sent = false; |
| 28 | } |
| 29 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 30 | int ath10k_bmi_done(struct ath10k *ar) |
| 31 | { |
| 32 | struct bmi_cmd cmd; |
| 33 | u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.done); |
| 34 | int ret; |
| 35 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 36 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi done\n"); |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 37 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 38 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 39 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi skipped\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 40 | return 0; |
| 41 | } |
| 42 | |
| 43 | ar->bmi.done_sent = true; |
| 44 | cmd.id = __cpu_to_le32(BMI_DONE); |
| 45 | |
| 46 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, NULL, NULL); |
| 47 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 48 | ath10k_warn(ar, "unable to write to the device: %d\n", ret); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 49 | return ret; |
| 50 | } |
| 51 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 52 | return 0; |
| 53 | } |
| 54 | |
| 55 | int ath10k_bmi_get_target_info(struct ath10k *ar, |
| 56 | struct bmi_target_info *target_info) |
| 57 | { |
| 58 | struct bmi_cmd cmd; |
| 59 | union bmi_resp resp; |
| 60 | u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.get_target_info); |
| 61 | u32 resplen = sizeof(resp.get_target_info); |
| 62 | int ret; |
| 63 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 64 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi get target info\n"); |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 65 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 66 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 67 | ath10k_warn(ar, "BMI Get Target Info Command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 68 | return -EBUSY; |
| 69 | } |
| 70 | |
| 71 | cmd.id = __cpu_to_le32(BMI_GET_TARGET_INFO); |
| 72 | |
| 73 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, &resp, &resplen); |
| 74 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 75 | ath10k_warn(ar, "unable to get target info from device\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 76 | return ret; |
| 77 | } |
| 78 | |
| 79 | if (resplen < sizeof(resp.get_target_info)) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 80 | ath10k_warn(ar, "invalid get_target_info response length (%d)\n", |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 81 | resplen); |
| 82 | return -EIO; |
| 83 | } |
| 84 | |
| 85 | target_info->version = __le32_to_cpu(resp.get_target_info.version); |
| 86 | target_info->type = __le32_to_cpu(resp.get_target_info.type); |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 87 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 88 | return 0; |
| 89 | } |
| 90 | |
| 91 | int ath10k_bmi_read_memory(struct ath10k *ar, |
| 92 | u32 address, void *buffer, u32 length) |
| 93 | { |
| 94 | struct bmi_cmd cmd; |
| 95 | union bmi_resp resp; |
| 96 | u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.read_mem); |
| 97 | u32 rxlen; |
| 98 | int ret; |
| 99 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 100 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi read address 0x%x length %d\n", |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 101 | address, length); |
| 102 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 103 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 104 | ath10k_warn(ar, "command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 105 | return -EBUSY; |
| 106 | } |
| 107 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 108 | while (length) { |
| 109 | rxlen = min_t(u32, length, BMI_MAX_DATA_SIZE); |
| 110 | |
| 111 | cmd.id = __cpu_to_le32(BMI_READ_MEMORY); |
| 112 | cmd.read_mem.addr = __cpu_to_le32(address); |
| 113 | cmd.read_mem.len = __cpu_to_le32(rxlen); |
| 114 | |
| 115 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, |
| 116 | &resp, &rxlen); |
| 117 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 118 | ath10k_warn(ar, "unable to read from the device (%d)\n", |
Michal Kazior | ed48b35 | 2013-07-05 16:15:10 +0300 | [diff] [blame] | 119 | ret); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 120 | return ret; |
| 121 | } |
| 122 | |
| 123 | memcpy(buffer, resp.read_mem.payload, rxlen); |
| 124 | address += rxlen; |
| 125 | buffer += rxlen; |
| 126 | length -= rxlen; |
| 127 | } |
| 128 | |
| 129 | return 0; |
| 130 | } |
| 131 | |
| 132 | int ath10k_bmi_write_memory(struct ath10k *ar, |
| 133 | u32 address, const void *buffer, u32 length) |
| 134 | { |
| 135 | struct bmi_cmd cmd; |
| 136 | u32 hdrlen = sizeof(cmd.id) + sizeof(cmd.write_mem); |
| 137 | u32 txlen; |
| 138 | int ret; |
| 139 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 140 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi write address 0x%x length %d\n", |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 141 | address, length); |
| 142 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 143 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 144 | ath10k_warn(ar, "command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 145 | return -EBUSY; |
| 146 | } |
| 147 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 148 | while (length) { |
| 149 | txlen = min(length, BMI_MAX_DATA_SIZE - hdrlen); |
| 150 | |
| 151 | /* copy before roundup to avoid reading beyond buffer*/ |
| 152 | memcpy(cmd.write_mem.payload, buffer, txlen); |
| 153 | txlen = roundup(txlen, 4); |
| 154 | |
| 155 | cmd.id = __cpu_to_le32(BMI_WRITE_MEMORY); |
| 156 | cmd.write_mem.addr = __cpu_to_le32(address); |
| 157 | cmd.write_mem.len = __cpu_to_le32(txlen); |
| 158 | |
| 159 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, hdrlen + txlen, |
| 160 | NULL, NULL); |
| 161 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 162 | ath10k_warn(ar, "unable to write to the device (%d)\n", |
Michal Kazior | ed48b35 | 2013-07-05 16:15:10 +0300 | [diff] [blame] | 163 | ret); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 164 | return ret; |
| 165 | } |
| 166 | |
| 167 | /* fixup roundup() so `length` zeroes out for last chunk */ |
| 168 | txlen = min(txlen, length); |
| 169 | |
| 170 | address += txlen; |
| 171 | buffer += txlen; |
| 172 | length -= txlen; |
| 173 | } |
| 174 | |
| 175 | return 0; |
| 176 | } |
| 177 | |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 178 | int ath10k_bmi_execute(struct ath10k *ar, u32 address, u32 param, u32 *result) |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 179 | { |
| 180 | struct bmi_cmd cmd; |
| 181 | union bmi_resp resp; |
| 182 | u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.execute); |
| 183 | u32 resplen = sizeof(resp.execute); |
| 184 | int ret; |
| 185 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 186 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi execute address 0x%x param 0x%x\n", |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 187 | address, param); |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 188 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 189 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 190 | ath10k_warn(ar, "command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 191 | return -EBUSY; |
| 192 | } |
| 193 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 194 | cmd.id = __cpu_to_le32(BMI_EXECUTE); |
| 195 | cmd.execute.addr = __cpu_to_le32(address); |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 196 | cmd.execute.param = __cpu_to_le32(param); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 197 | |
| 198 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, &resp, &resplen); |
| 199 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 200 | ath10k_warn(ar, "unable to read from the device\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 201 | return ret; |
| 202 | } |
| 203 | |
| 204 | if (resplen < sizeof(resp.execute)) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 205 | ath10k_warn(ar, "invalid execute response length (%d)\n", |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 206 | resplen); |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 207 | return -EIO; |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 208 | } |
| 209 | |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 210 | *result = __le32_to_cpu(resp.execute.result); |
| 211 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 212 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi execute result 0x%x\n", *result); |
Kalle Valo | d6d4a58 | 2014-03-11 17:33:19 +0200 | [diff] [blame] | 213 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 214 | return 0; |
| 215 | } |
| 216 | |
| 217 | int ath10k_bmi_lz_data(struct ath10k *ar, const void *buffer, u32 length) |
| 218 | { |
| 219 | struct bmi_cmd cmd; |
| 220 | u32 hdrlen = sizeof(cmd.id) + sizeof(cmd.lz_data); |
| 221 | u32 txlen; |
| 222 | int ret; |
| 223 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 224 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi lz data buffer 0x%p length %d\n", |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 225 | buffer, length); |
| 226 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 227 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 228 | ath10k_warn(ar, "command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 229 | return -EBUSY; |
| 230 | } |
| 231 | |
| 232 | while (length) { |
| 233 | txlen = min(length, BMI_MAX_DATA_SIZE - hdrlen); |
| 234 | |
| 235 | WARN_ON_ONCE(txlen & 3); |
| 236 | |
| 237 | cmd.id = __cpu_to_le32(BMI_LZ_DATA); |
| 238 | cmd.lz_data.len = __cpu_to_le32(txlen); |
| 239 | memcpy(cmd.lz_data.payload, buffer, txlen); |
| 240 | |
| 241 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, hdrlen + txlen, |
| 242 | NULL, NULL); |
| 243 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 244 | ath10k_warn(ar, "unable to write to the device\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 245 | return ret; |
| 246 | } |
| 247 | |
| 248 | buffer += txlen; |
| 249 | length -= txlen; |
| 250 | } |
| 251 | |
| 252 | return 0; |
| 253 | } |
| 254 | |
| 255 | int ath10k_bmi_lz_stream_start(struct ath10k *ar, u32 address) |
| 256 | { |
| 257 | struct bmi_cmd cmd; |
| 258 | u32 cmdlen = sizeof(cmd.id) + sizeof(cmd.lz_start); |
| 259 | int ret; |
| 260 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 261 | ath10k_dbg(ar, ATH10K_DBG_BMI, "bmi lz stream start address 0x%x\n", |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 262 | address); |
| 263 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 264 | if (ar->bmi.done_sent) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 265 | ath10k_warn(ar, "command disallowed\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 266 | return -EBUSY; |
| 267 | } |
| 268 | |
| 269 | cmd.id = __cpu_to_le32(BMI_LZ_STREAM_START); |
| 270 | cmd.lz_start.addr = __cpu_to_le32(address); |
| 271 | |
| 272 | ret = ath10k_hif_exchange_bmi_msg(ar, &cmd, cmdlen, NULL, NULL); |
| 273 | if (ret) { |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 274 | ath10k_warn(ar, "unable to Start LZ Stream to the device\n"); |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 275 | return ret; |
| 276 | } |
| 277 | |
| 278 | return 0; |
| 279 | } |
| 280 | |
| 281 | int ath10k_bmi_fast_download(struct ath10k *ar, |
| 282 | u32 address, const void *buffer, u32 length) |
| 283 | { |
| 284 | u8 trailer[4] = {}; |
| 285 | u32 head_len = rounddown(length, 4); |
| 286 | u32 trailer_len = length - head_len; |
| 287 | int ret; |
| 288 | |
Michal Kazior | 7aa7a72 | 2014-08-25 12:09:38 +0200 | [diff] [blame] | 289 | ath10k_dbg(ar, ATH10K_DBG_BMI, |
Kalle Valo | f0bbea9 | 2013-09-08 17:55:32 +0300 | [diff] [blame] | 290 | "bmi fast download address 0x%x buffer 0x%p length %d\n", |
| 291 | address, buffer, length); |
| 292 | |
Kalle Valo | 5e3dd15 | 2013-06-12 20:52:10 +0300 | [diff] [blame] | 293 | ret = ath10k_bmi_lz_stream_start(ar, address); |
| 294 | if (ret) |
| 295 | return ret; |
| 296 | |
| 297 | /* copy the last word into a zero padded buffer */ |
| 298 | if (trailer_len > 0) |
| 299 | memcpy(trailer, buffer + head_len, trailer_len); |
| 300 | |
| 301 | ret = ath10k_bmi_lz_data(ar, buffer, head_len); |
| 302 | if (ret) |
| 303 | return ret; |
| 304 | |
| 305 | if (trailer_len > 0) |
| 306 | ret = ath10k_bmi_lz_data(ar, trailer, 4); |
| 307 | |
| 308 | if (ret != 0) |
| 309 | return ret; |
| 310 | |
| 311 | /* |
| 312 | * Close compressed stream and open a new (fake) one. |
| 313 | * This serves mainly to flush Target caches. |
| 314 | */ |
| 315 | ret = ath10k_bmi_lz_stream_start(ar, 0x00); |
| 316 | |
| 317 | return ret; |
| 318 | } |