2 * Copyright (c) 2012 Broadcom Corporation
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 /* FWIL is the Firmware Interface Layer. In this module the support functions
18 * are located to set and get variables to and from the firmware.
21 #include <linux/kernel.h>
22 #include <linux/netdevice.h>
23 #include <brcmu_utils.h>
24 #include <brcmu_wifi.h>
28 #include "tracepoint.h"
33 #define MAX_HEX_DUMP_LEN 64
36 static const char * const brcmf_fil_errstr
[] = {
56 "BCME_OUTOFRANGECHAN",
68 "BCME_WME_NOT_ENABLED",
69 "BCME_TSPEC_NOTFOUND",
70 "BCME_ACM_NOTSUPPORTED",
71 "BCME_NOT_WME_ASSOCIATION",
78 "BCME_NMODE_DISABLED",
83 "BCME_SERIAL_PORT_ERR",
92 static const char *brcmf_fil_get_errstr(u32 err
)
94 if (err
>= ARRAY_SIZE(brcmf_fil_errstr
))
97 return brcmf_fil_errstr
[err
];
100 static const char *brcmf_fil_get_errstr(u32 err
)
107 brcmf_fil_cmd_data(struct brcmf_if
*ifp
, u32 cmd
, void *data
, u32 len
, bool set
)
109 struct brcmf_pub
*drvr
= ifp
->drvr
;
112 if (drvr
->bus_if
->state
!= BRCMF_BUS_UP
) {
113 brcmf_err("bus is down. we have nothing to do.\n");
118 len
= min_t(uint
, len
, BRCMF_DCMD_MAXLEN
);
120 err
= brcmf_proto_set_dcmd(drvr
, ifp
->ifidx
, cmd
, data
, len
);
122 err
= brcmf_proto_query_dcmd(drvr
, ifp
->ifidx
, cmd
, data
, len
);
127 brcmf_dbg(FIL
, "Failed: %s (%d)\n",
128 brcmf_fil_get_errstr((u32
)(-err
)), err
);
133 brcmf_fil_cmd_data_set(struct brcmf_if
*ifp
, u32 cmd
, void *data
, u32 len
)
137 mutex_lock(&ifp
->drvr
->proto_block
);
139 brcmf_dbg(FIL
, "ifidx=%d, cmd=%d, len=%d\n", ifp
->ifidx
, cmd
, len
);
140 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
141 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
143 err
= brcmf_fil_cmd_data(ifp
, cmd
, data
, len
, true);
144 mutex_unlock(&ifp
->drvr
->proto_block
);
150 brcmf_fil_cmd_data_get(struct brcmf_if
*ifp
, u32 cmd
, void *data
, u32 len
)
154 mutex_lock(&ifp
->drvr
->proto_block
);
155 err
= brcmf_fil_cmd_data(ifp
, cmd
, data
, len
, false);
157 brcmf_dbg(FIL
, "ifidx=%d, cmd=%d, len=%d\n", ifp
->ifidx
, cmd
, len
);
158 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
159 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
161 mutex_unlock(&ifp
->drvr
->proto_block
);
168 brcmf_fil_cmd_int_set(struct brcmf_if
*ifp
, u32 cmd
, u32 data
)
171 __le32 data_le
= cpu_to_le32(data
);
173 mutex_lock(&ifp
->drvr
->proto_block
);
174 brcmf_dbg(FIL
, "ifidx=%d, cmd=%d, value=%d\n", ifp
->ifidx
, cmd
, data
);
175 err
= brcmf_fil_cmd_data(ifp
, cmd
, &data_le
, sizeof(data_le
), true);
176 mutex_unlock(&ifp
->drvr
->proto_block
);
182 brcmf_fil_cmd_int_get(struct brcmf_if
*ifp
, u32 cmd
, u32
*data
)
185 __le32 data_le
= cpu_to_le32(*data
);
187 mutex_lock(&ifp
->drvr
->proto_block
);
188 err
= brcmf_fil_cmd_data(ifp
, cmd
, &data_le
, sizeof(data_le
), false);
189 mutex_unlock(&ifp
->drvr
->proto_block
);
190 *data
= le32_to_cpu(data_le
);
191 brcmf_dbg(FIL
, "ifidx=%d, cmd=%d, value=%d\n", ifp
->ifidx
, cmd
, *data
);
197 brcmf_create_iovar(char *name
, const char *data
, u32 datalen
,
198 char *buf
, u32 buflen
)
202 len
= strlen(name
) + 1;
204 if ((len
+ datalen
) > buflen
)
207 memcpy(buf
, name
, len
);
209 /* append data onto the end of the name string */
211 memcpy(&buf
[len
], data
, datalen
);
213 return len
+ datalen
;
218 brcmf_fil_iovar_data_set(struct brcmf_if
*ifp
, char *name
, const void *data
,
221 struct brcmf_pub
*drvr
= ifp
->drvr
;
225 mutex_lock(&drvr
->proto_block
);
227 brcmf_dbg(FIL
, "ifidx=%d, name=%s, len=%d\n", ifp
->ifidx
, name
, len
);
228 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
229 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
231 buflen
= brcmf_create_iovar(name
, data
, len
, drvr
->proto_buf
,
232 sizeof(drvr
->proto_buf
));
234 err
= brcmf_fil_cmd_data(ifp
, BRCMF_C_SET_VAR
, drvr
->proto_buf
,
238 brcmf_err("Creating iovar failed\n");
241 mutex_unlock(&drvr
->proto_block
);
246 brcmf_fil_iovar_data_get(struct brcmf_if
*ifp
, char *name
, void *data
,
249 struct brcmf_pub
*drvr
= ifp
->drvr
;
253 mutex_lock(&drvr
->proto_block
);
255 buflen
= brcmf_create_iovar(name
, data
, len
, drvr
->proto_buf
,
256 sizeof(drvr
->proto_buf
));
258 err
= brcmf_fil_cmd_data(ifp
, BRCMF_C_GET_VAR
, drvr
->proto_buf
,
261 memcpy(data
, drvr
->proto_buf
, len
);
264 brcmf_err("Creating iovar failed\n");
267 brcmf_dbg(FIL
, "ifidx=%d, name=%s, len=%d\n", ifp
->ifidx
, name
, len
);
268 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
269 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
271 mutex_unlock(&drvr
->proto_block
);
276 brcmf_fil_iovar_int_set(struct brcmf_if
*ifp
, char *name
, u32 data
)
278 __le32 data_le
= cpu_to_le32(data
);
280 return brcmf_fil_iovar_data_set(ifp
, name
, &data_le
, sizeof(data_le
));
284 brcmf_fil_iovar_int_get(struct brcmf_if
*ifp
, char *name
, u32
*data
)
286 __le32 data_le
= cpu_to_le32(*data
);
289 err
= brcmf_fil_iovar_data_get(ifp
, name
, &data_le
, sizeof(data_le
));
291 *data
= le32_to_cpu(data_le
);
296 brcmf_create_bsscfg(s32 bssidx
, char *name
, char *data
, u32 datalen
, char *buf
,
299 const s8
*prefix
= "bsscfg:";
307 return brcmf_create_iovar(name
, data
, datalen
, buf
, buflen
);
309 prefixlen
= strlen(prefix
);
310 namelen
= strlen(name
) + 1; /* lengh of iovar name + null */
311 iolen
= prefixlen
+ namelen
+ sizeof(bssidx_le
) + datalen
;
313 if (buflen
< iolen
) {
314 brcmf_err("buffer is too short\n");
320 /* copy prefix, no null */
321 memcpy(p
, prefix
, prefixlen
);
324 /* copy iovar name including null */
325 memcpy(p
, name
, namelen
);
328 /* bss config index as first data */
329 bssidx_le
= cpu_to_le32(bssidx
);
330 memcpy(p
, &bssidx_le
, sizeof(bssidx_le
));
331 p
+= sizeof(bssidx_le
);
333 /* parameter buffer follows */
335 memcpy(p
, data
, datalen
);
341 brcmf_fil_bsscfg_data_set(struct brcmf_if
*ifp
, char *name
,
344 struct brcmf_pub
*drvr
= ifp
->drvr
;
348 mutex_lock(&drvr
->proto_block
);
350 brcmf_dbg(FIL
, "ifidx=%d, bssidx=%d, name=%s, len=%d\n", ifp
->ifidx
,
351 ifp
->bssidx
, name
, len
);
352 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
353 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
355 buflen
= brcmf_create_bsscfg(ifp
->bssidx
, name
, data
, len
,
356 drvr
->proto_buf
, sizeof(drvr
->proto_buf
));
358 err
= brcmf_fil_cmd_data(ifp
, BRCMF_C_SET_VAR
, drvr
->proto_buf
,
362 brcmf_err("Creating bsscfg failed\n");
365 mutex_unlock(&drvr
->proto_block
);
370 brcmf_fil_bsscfg_data_get(struct brcmf_if
*ifp
, char *name
,
373 struct brcmf_pub
*drvr
= ifp
->drvr
;
377 mutex_lock(&drvr
->proto_block
);
379 buflen
= brcmf_create_bsscfg(ifp
->bssidx
, name
, data
, len
,
380 drvr
->proto_buf
, sizeof(drvr
->proto_buf
));
382 err
= brcmf_fil_cmd_data(ifp
, BRCMF_C_GET_VAR
, drvr
->proto_buf
,
385 memcpy(data
, drvr
->proto_buf
, len
);
388 brcmf_err("Creating bsscfg failed\n");
390 brcmf_dbg(FIL
, "ifidx=%d, bssidx=%d, name=%s, len=%d\n", ifp
->ifidx
,
391 ifp
->bssidx
, name
, len
);
392 brcmf_dbg_hex_dump(BRCMF_FIL_ON(), data
,
393 min_t(uint
, len
, MAX_HEX_DUMP_LEN
), "data\n");
395 mutex_unlock(&drvr
->proto_block
);
401 brcmf_fil_bsscfg_int_set(struct brcmf_if
*ifp
, char *name
, u32 data
)
403 __le32 data_le
= cpu_to_le32(data
);
405 return brcmf_fil_bsscfg_data_set(ifp
, name
, &data_le
,
410 brcmf_fil_bsscfg_int_get(struct brcmf_if
*ifp
, char *name
, u32
*data
)
412 __le32 data_le
= cpu_to_le32(*data
);
415 err
= brcmf_fil_bsscfg_data_get(ifp
, name
, &data_le
,
418 *data
= le32_to_cpu(data_le
);
This page took 0.042454 seconds and 5 git commands to generate.