| // SPDX-License-Identifier: GPL-2.0 |
| /* |
| * Copyright (c) 2012 - 2018 Microchip Technology Inc., and its subsidiaries. |
| * All rights reserved. |
| */ |
| |
| #include "wilc_wlan_if.h" |
| #include "wilc_wlan.h" |
| #include "wilc_wlan_cfg.h" |
| #include "wilc_wfi_netdevice.h" |
| |
| enum cfg_cmd_type { |
| CFG_BYTE_CMD = 0, |
| CFG_HWORD_CMD = 1, |
| CFG_WORD_CMD = 2, |
| CFG_STR_CMD = 3, |
| CFG_BIN_CMD = 4 |
| }; |
| |
| static const struct wilc_cfg_byte g_cfg_byte[] = { |
| {WID_STATUS, 0}, |
| {WID_RSSI, 0}, |
| {WID_LINKSPEED, 0}, |
| {WID_NIL, 0} |
| }; |
| |
| static const struct wilc_cfg_hword g_cfg_hword[] = { |
| {WID_NIL, 0} |
| }; |
| |
| static const struct wilc_cfg_word g_cfg_word[] = { |
| {WID_FAILED_COUNT, 0}, |
| {WID_RECEIVED_FRAGMENT_COUNT, 0}, |
| {WID_SUCCESS_FRAME_COUNT, 0}, |
| {WID_GET_INACTIVE_TIME, 0}, |
| {WID_NIL, 0} |
| |
| }; |
| |
| static const struct wilc_cfg_str g_cfg_str[] = { |
| {WID_FIRMWARE_VERSION, NULL}, |
| {WID_MAC_ADDR, NULL}, |
| {WID_ASSOC_RES_INFO, NULL}, |
| {WID_NIL, NULL} |
| }; |
| |
| /******************************************** |
| * |
| * Configuration Functions |
| * |
| ********************************************/ |
| |
| static int wilc_wlan_cfg_set_byte(u8 *frame, u32 offset, u16 id, u8 val8) |
| { |
| if ((offset + 4) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| put_unaligned_le16(1, &frame[offset + 2]); |
| frame[offset + 4] = val8; |
| return 5; |
| } |
| |
| static int wilc_wlan_cfg_set_hword(u8 *frame, u32 offset, u16 id, u16 val16) |
| { |
| if ((offset + 5) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| put_unaligned_le16(2, &frame[offset + 2]); |
| put_unaligned_le16(val16, &frame[offset + 4]); |
| |
| return 6; |
| } |
| |
| static int wilc_wlan_cfg_set_word(u8 *frame, u32 offset, u16 id, u32 val32) |
| { |
| if ((offset + 7) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| put_unaligned_le16(4, &frame[offset + 2]); |
| put_unaligned_le32(val32, &frame[offset + 4]); |
| |
| return 8; |
| } |
| |
| static int wilc_wlan_cfg_set_str(u8 *frame, u32 offset, u16 id, u8 *str, |
| u32 size) |
| { |
| if ((offset + size + 4) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| put_unaligned_le16(size, &frame[offset + 2]); |
| if (str && size != 0) |
| memcpy(&frame[offset + 4], str, size); |
| |
| return (size + 4); |
| } |
| |
| static int wilc_wlan_cfg_set_bin(u8 *frame, u32 offset, u16 id, u8 *b, u32 size) |
| { |
| u32 i; |
| u8 checksum = 0; |
| |
| if ((offset + size + 5) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| put_unaligned_le16(size, &frame[offset + 2]); |
| |
| if ((b) && size != 0) { |
| memcpy(&frame[offset + 4], b, size); |
| for (i = 0; i < size; i++) |
| checksum += frame[offset + i + 4]; |
| } |
| |
| frame[offset + size + 4] = checksum; |
| |
| return (size + 5); |
| } |
| |
| /******************************************** |
| * |
| * Configuration Response Functions |
| * |
| ********************************************/ |
| |
| #define GET_WID_TYPE(wid) (((wid) >> 12) & 0x7) |
| static void wilc_wlan_parse_response_frame(struct wilc *wl, u8 *info, int size) |
| { |
| u16 wid; |
| u32 len = 0, i = 0; |
| |
| while (size > 0) { |
| i = 0; |
| wid = get_unaligned_le16(info); |
| |
| switch (GET_WID_TYPE(wid)) { |
| case WID_CHAR: |
| do { |
| if (wl->cfg.b[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.b[i].id == wid) { |
| wl->cfg.b[i].val = info[4]; |
| break; |
| } |
| i++; |
| } while (1); |
| len = 3; |
| break; |
| |
| case WID_SHORT: |
| do { |
| struct wilc_cfg_hword *hw = &wl->cfg.hw[i]; |
| |
| if (hw->id == WID_NIL) |
| break; |
| |
| if (hw->id == wid) { |
| hw->val = get_unaligned_le16(&info[4]); |
| break; |
| } |
| i++; |
| } while (1); |
| len = 4; |
| break; |
| |
| case WID_INT: |
| do { |
| struct wilc_cfg_word *w = &wl->cfg.w[i]; |
| |
| if (w->id == WID_NIL) |
| break; |
| |
| if (w->id == wid) { |
| w->val = get_unaligned_le32(&info[4]); |
| break; |
| } |
| i++; |
| } while (1); |
| len = 6; |
| break; |
| |
| case WID_STR: |
| do { |
| if (wl->cfg.s[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.s[i].id == wid) { |
| memcpy(wl->cfg.s[i].str, &info[2], |
| (info[2] + 2)); |
| break; |
| } |
| i++; |
| } while (1); |
| len = 2 + info[2]; |
| break; |
| |
| default: |
| break; |
| } |
| size -= (2 + len); |
| info += (2 + len); |
| } |
| } |
| |
| static void wilc_wlan_parse_info_frame(struct wilc *wl, u8 *info) |
| { |
| u32 wid, len; |
| |
| wid = get_unaligned_le16(info); |
| |
| len = info[2]; |
| |
| if (len == 1 && wid == WID_STATUS) { |
| int i = 0; |
| |
| do { |
| if (wl->cfg.b[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.b[i].id == wid) { |
| wl->cfg.b[i].val = info[3]; |
| break; |
| } |
| i++; |
| } while (1); |
| } |
| } |
| |
| /******************************************** |
| * |
| * Configuration Exported Functions |
| * |
| ********************************************/ |
| |
| int wilc_wlan_cfg_set_wid(u8 *frame, u32 offset, u16 id, u8 *buf, int size) |
| { |
| u8 type = (id >> 12) & 0xf; |
| int ret = 0; |
| |
| switch (type) { |
| case CFG_BYTE_CMD: |
| if (size >= 1) |
| ret = wilc_wlan_cfg_set_byte(frame, offset, id, *buf); |
| break; |
| |
| case CFG_HWORD_CMD: |
| if (size >= 2) |
| ret = wilc_wlan_cfg_set_hword(frame, offset, id, |
| *((u16 *)buf)); |
| break; |
| |
| case CFG_WORD_CMD: |
| if (size >= 4) |
| ret = wilc_wlan_cfg_set_word(frame, offset, id, |
| *((u32 *)buf)); |
| break; |
| |
| case CFG_STR_CMD: |
| ret = wilc_wlan_cfg_set_str(frame, offset, id, buf, size); |
| break; |
| |
| case CFG_BIN_CMD: |
| ret = wilc_wlan_cfg_set_bin(frame, offset, id, buf, size); |
| break; |
| } |
| |
| return ret; |
| } |
| |
| int wilc_wlan_cfg_get_wid(u8 *frame, u32 offset, u16 id) |
| { |
| if ((offset + 2) >= WILC_MAX_CFG_FRAME_SIZE) |
| return 0; |
| |
| put_unaligned_le16(id, &frame[offset]); |
| |
| return 2; |
| } |
| |
| int wilc_wlan_cfg_get_val(struct wilc *wl, u16 wid, u8 *buffer, |
| u32 buffer_size) |
| { |
| u32 type = (wid >> 12) & 0xf; |
| int i, ret = 0; |
| |
| i = 0; |
| if (type == CFG_BYTE_CMD) { |
| do { |
| if (wl->cfg.b[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.b[i].id == wid) { |
| memcpy(buffer, &wl->cfg.b[i].val, 1); |
| ret = 1; |
| break; |
| } |
| i++; |
| } while (1); |
| } else if (type == CFG_HWORD_CMD) { |
| do { |
| if (wl->cfg.hw[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.hw[i].id == wid) { |
| memcpy(buffer, &wl->cfg.hw[i].val, 2); |
| ret = 2; |
| break; |
| } |
| i++; |
| } while (1); |
| } else if (type == CFG_WORD_CMD) { |
| do { |
| if (wl->cfg.w[i].id == WID_NIL) |
| break; |
| |
| if (wl->cfg.w[i].id == wid) { |
| memcpy(buffer, &wl->cfg.w[i].val, 4); |
| ret = 4; |
| break; |
| } |
| i++; |
| } while (1); |
| } else if (type == CFG_STR_CMD) { |
| do { |
| u32 id = wl->cfg.s[i].id; |
| |
| if (id == WID_NIL) |
| break; |
| |
| if (id == wid) { |
| u16 size = get_unaligned_le16(wl->cfg.s[i].str); |
| |
| if (buffer_size >= size) { |
| memcpy(buffer, &wl->cfg.s[i].str[2], |
| size); |
| ret = size; |
| } |
| break; |
| } |
| i++; |
| } while (1); |
| } |
| return ret; |
| } |
| |
| void wilc_wlan_cfg_indicate_rx(struct wilc *wilc, u8 *frame, int size, |
| struct wilc_cfg_rsp *rsp) |
| { |
| u8 msg_type; |
| u8 msg_id; |
| |
| msg_type = frame[0]; |
| msg_id = frame[1]; /* seq no */ |
| frame += 4; |
| size -= 4; |
| rsp->type = 0; |
| |
| /* |
| * The valid types of response messages are |
| * 'R' (Response), |
| * 'I' (Information), and |
| * 'N' (Network Information) |
| */ |
| |
| switch (msg_type) { |
| case 'R': |
| wilc_wlan_parse_response_frame(wilc, frame, size); |
| rsp->type = WILC_CFG_RSP; |
| rsp->seq_no = msg_id; |
| break; |
| |
| case 'I': |
| wilc_wlan_parse_info_frame(wilc, frame); |
| rsp->type = WILC_CFG_RSP_STATUS; |
| rsp->seq_no = msg_id; |
| /*call host interface info parse as well*/ |
| wilc_gnrl_async_info_received(wilc, frame - 4, size + 4); |
| break; |
| |
| case 'N': |
| wilc_network_info_received(wilc, frame - 4, size + 4); |
| break; |
| |
| case 'S': |
| wilc_scan_complete_received(wilc, frame - 4, size + 4); |
| break; |
| |
| default: |
| rsp->seq_no = msg_id; |
| break; |
| } |
| } |
| |
| int wilc_wlan_cfg_init(struct wilc *wl) |
| { |
| struct wilc_cfg_str_vals *str_vals; |
| int i = 0; |
| |
| wl->cfg.b = kmemdup(g_cfg_byte, sizeof(g_cfg_byte), GFP_KERNEL); |
| if (!wl->cfg.b) |
| return -ENOMEM; |
| |
| wl->cfg.hw = kmemdup(g_cfg_hword, sizeof(g_cfg_hword), GFP_KERNEL); |
| if (!wl->cfg.hw) |
| goto out_b; |
| |
| wl->cfg.w = kmemdup(g_cfg_word, sizeof(g_cfg_word), GFP_KERNEL); |
| if (!wl->cfg.w) |
| goto out_hw; |
| |
| wl->cfg.s = kmemdup(g_cfg_str, sizeof(g_cfg_str), GFP_KERNEL); |
| if (!wl->cfg.s) |
| goto out_w; |
| |
| str_vals = kzalloc(sizeof(*str_vals), GFP_KERNEL); |
| if (!str_vals) |
| goto out_s; |
| |
| wl->cfg.str_vals = str_vals; |
| /* store the string cfg parameters */ |
| wl->cfg.s[i].id = WID_FIRMWARE_VERSION; |
| wl->cfg.s[i].str = str_vals->firmware_version; |
| i++; |
| wl->cfg.s[i].id = WID_MAC_ADDR; |
| wl->cfg.s[i].str = str_vals->mac_address; |
| i++; |
| wl->cfg.s[i].id = WID_ASSOC_RES_INFO; |
| wl->cfg.s[i].str = str_vals->assoc_rsp; |
| i++; |
| wl->cfg.s[i].id = WID_NIL; |
| wl->cfg.s[i].str = NULL; |
| return 0; |
| |
| out_s: |
| kfree(wl->cfg.s); |
| out_w: |
| kfree(wl->cfg.w); |
| out_hw: |
| kfree(wl->cfg.hw); |
| out_b: |
| kfree(wl->cfg.b); |
| return -ENOMEM; |
| } |
| |
| void wilc_wlan_cfg_deinit(struct wilc *wl) |
| { |
| kfree(wl->cfg.b); |
| kfree(wl->cfg.hw); |
| kfree(wl->cfg.w); |
| kfree(wl->cfg.s); |
| kfree(wl->cfg.str_vals); |
| } |