/*****************************************************************************
函 数 名 : sdt_drv_netlink_recv
功能描述 : 从SDT APP侧接收到数据
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年1月28日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_void sdt_drv_netlink_recv(oal_netbuf_stru *pst_netbuf)
{
oal_netbuf_stru *pst_net_buf = OAL_PTR_NULL;
oal_nlmsghdr_stru *pst_nlhdr = OAL_PTR_NULL;
sdt_drv_netlink_msg_hdr_stru st_msg_hdr;
oal_int32 l_len;
if (OAL_PTR_NULL == pst_netbuf)
{
OAL_IO_PRINT("sdt_drv_netlink_recv::pst_netbuf is null!\n");
return;
}
OAL_MEMZERO(g_st_sdt_drv_mng_entry.puc_data, DATA_BUF_LEN);
pst_net_buf = oal_netbuf_get(pst_netbuf);
if (OAL_NETBUF_LEN(pst_net_buf) >= OAL_NLMSG_SPACE(0))
{
pst_nlhdr = oal_nlmsg_hdr((OAL_CONST oal_netbuf_stru *)pst_net_buf);
l_len = (oal_int32)OAL_NLMSG_PAYLOAD(pst_nlhdr, 0);
if(l_len <= DATA_BUF_LEN)
{
oal_memcopy((oal_void *)g_st_sdt_drv_mng_entry.puc_data,
(const oal_void *)OAL_NLMSG_DATA(pst_nlhdr),
(oal_uint32)l_len);
}
else
{
/*overflow*/
OAL_IO_PRINT("[ERROR]invaild netlink buff len:%u,max len:%u\n",(oal_uint32)l_len,DATA_BUF_LEN);
oal_mem_sdt_netbuf_free(pst_net_buf, OAL_TRUE);
return;
}
oal_memcopy((oal_void *)&st_msg_hdr,
(const oal_void *)g_st_sdt_drv_mng_entry.puc_data,
(oal_uint32)OAL_SIZEOF(st_msg_hdr));
if (NETLINK_MSG_HELLO == st_msg_hdr.ul_cmd)
{
g_st_sdt_drv_mng_entry.ul_usepid = pst_nlhdr->nlmsg_pid; /*pid of sending process */
OAL_IO_PRINT("%s pid is-->%d \n", OAL_FUNC_NAME, g_st_sdt_drv_mng_entry.ul_usepid);
}
else
{
sdt_drv_send_data_to_wifi(&g_st_sdt_drv_mng_entry.puc_data[OAL_SIZEOF(st_msg_hdr)], l_len - (oal_int32)OAL_SIZEOF(st_msg_hdr));
}
}
oal_mem_sdt_netbuf_free(pst_net_buf, OAL_TRUE);
//oal_netbuf_free(pst_net_buf);
}
/*****************************************************************************
函 数 名 : oam_set_file_path
功能描述 : 1) 用于设置可维可测文件路径
2) 文件路径字符串的长度(包括\0)
输入参数 : 指向可维可测文件路径的指针
输出参数 : 无
返 回 值 : 1) OAL_ERR_CODE_PTR_NULL: 空指针
2) OAL_SUCC: 成功
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年9月26日
作 者 : huxiaotong
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_set_file_path(oal_int8 *pc_file_path, oal_uint32 ul_length)
{
#ifdef _PRE_WIFI_DMT
oal_file_stru *f_event_file;
oal_uint8 *puc_file_path;
if (OAL_PTR_NULL == pc_file_path)
{
return OAL_ERR_CODE_PTR_NULL;
}
if (ul_length > OAM_FILE_PATH_LENGTH)
{
return OAL_ERR_CODE_ARRAY_OVERFLOW;
}
puc_file_path = DmtStub_GetDebugFilePath();
oal_memcopy(g_st_oam_mng_ctx.ac_file_path, puc_file_path, strlen(puc_file_path));
/* 以下操作是为了将上一次的日志文件清空 */
f_event_file = oal_file_open_rw(g_st_oam_mng_ctx.ac_file_path);
if (OAL_FILE_FAIL == f_event_file)
{
return OAL_ERR_CODE_WRITE_FILE_FAIL;
}
if (0 != oal_file_close(f_event_file))
{
return OAL_ERR_CODE_CLOSE_FILE_FAIL;
}
#else
if (OAL_PTR_NULL == pc_file_path)
{
return OAL_ERR_CODE_PTR_NULL;
}
if (ul_length > OAM_FILE_PATH_LENGTH)
{
return OAL_ERR_CODE_ARRAY_OVERFLOW;
}
oal_memcopy(g_st_oam_mng_ctx.ac_file_path, pc_file_path, ul_length);
#endif
return OAL_SUCC;
}
/*****************************************************************************
函 数 名 : hmac_protection_set_mode
功能描述 : 同步保护相关的参数到Dmac
输入参数 : pst_hmac_vap : hmac vap结构体指针
输出参数 : 无
返 回 值 : oal_uint32
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2015年2月7日
作 者 : l00311403
修改内容 : 新生成函数
***************************************************************************/
OAL_STATIC oal_uint32 hmac_protection_sync_data(mac_vap_stru *pst_mac_vap)
{
mac_h2d_protection_stru st_h2d_prot;
wlan_mib_Dot11OperationEntry_stru *pst_mib;
oal_uint32 ul_ret = OAL_SUCC;
OAL_MEMZERO(&st_h2d_prot, OAL_SIZEOF(st_h2d_prot));
st_h2d_prot.ul_sync_mask |= H2D_SYNC_MASK_MIB;
st_h2d_prot.ul_sync_mask |= H2D_SYNC_MASK_PROT;
oal_memcopy((oal_uint8*)&st_h2d_prot.st_protection, (oal_uint8*)&pst_mac_vap->st_protection,
OAL_SIZEOF(mac_protection_stru));
pst_mib = &pst_mac_vap->pst_mib_info->st_wlan_mib_operation;
st_h2d_prot.en_dot11HTProtection = pst_mib->en_dot11HTProtection;
st_h2d_prot.en_dot11RIFSMode = pst_mib->en_dot11RIFSMode;
st_h2d_prot.en_dot11LSIGTXOPFullProtectionActivated =
pst_mib->en_dot11LSIGTXOPFullProtectionActivated;
st_h2d_prot.en_dot11NonGFEntitiesPresent = pst_mib->en_dot11NonGFEntitiesPresent;
if (OAL_TRUE == hmac_protection_need_sync(pst_mac_vap, &st_h2d_prot))
{
ul_ret = hmac_config_set_protection(pst_mac_vap, OAL_SIZEOF(st_h2d_prot),
(oal_uint8*)&st_h2d_prot);
}
return ul_ret;
}
oal_uint32 dmac_data_acq_report_data_unit(oal_uint8 *puc_daq_addr, oal_uint32 ul_len, oal_netbuf_stru *pst_netbuf)
{
dmac_data_acq_data_head_stru *pst_daq_data_head;
oal_int32 l_bytes = 0;
pst_daq_data_head = (dmac_data_acq_data_head_stru *)oal_netbuf_data(pst_netbuf);
/* 填写消息头 */
pst_daq_data_head->en_send_type = DMAC_DATA_ACQ_SEND_TYPE_UNIT;
pst_daq_data_head->ul_msg_sn = g_st_data_acq.ul_daq_sn;
pst_daq_data_head->ul_data_len = ul_len;
oal_memcopy((oal_uint8 *)pst_daq_data_head + DMAC_DATA_ACQ_DATA_HEAD_LEN, puc_daq_addr, ul_len);
l_bytes = oam_netlink_kernel_send(oal_netbuf_data(pst_netbuf), OAL_SIZEOF(dmac_data_acq_info_stru) + ul_len, OAM_NL_CMD_DAQ);
if (l_bytes <= 0)
{
OAM_ERROR_LOG1(0, OAM_SF_ANY, "{dmac_data_acq_report_data_unit::invalid l_bytes[%d].}", l_bytes);
return OAL_FAIL;
}
g_st_data_acq.ul_daq_sn++;
/* 等待APP侧接收完成 */
if (0 == g_st_data_acq.ul_daq_sn % DMAC_DATA_ACQ_PER_MAX_NUM)
{
dmac_data_acq_set_send_flag(OAL_FALSE);
}
return OAL_SUCC;
}
oal_uint32 oam_upload_device_log_to_sdt(oal_uint8 *pc_string, oal_uint16 len)
{
oal_netbuf_stru *pst_skb;
oal_uint32 ul_ret = OAL_SUCC;
if (OAL_PTR_NULL == pc_string)
{
OAL_IO_PRINT("oam_upload_log_to_sdt::pc_string is null!\n");
return OAL_ERR_CODE_PTR_NULL;
}
pst_skb = oam_alloc_data2sdt(len);
if (OAL_PTR_NULL == pst_skb)
{
OAL_IO_PRINT("alloc netbuf stru failed!\n");
return OAL_ERR_CODE_PTR_NULL;
}
/* COPY打印的内容 */
oal_memcopy(oal_netbuf_data(pst_skb), pc_string, len);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_skb, OAM_DATA_TYPE_DEVICE_LOG, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
/*****************************************************************************
函 数 名 : oam_upload_log_to_sdt
功能描述 : 打印信息到PC侧可维可测工具平台中
输入参数 : pc_string : 需要打印到可维可测工具平台中的字符串，以\0结束。
输出参数 : 无
返 回 值 : OAL_SUCC或其他错误码。
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年10月15日
作 者 : c59720
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_upload_log_to_sdt(oal_int8 *pc_string)
{
oal_netbuf_stru *pst_skb;
oal_uint32 ul_ret = OAL_SUCC;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
if (OAL_PTR_NULL == pc_string)
{
OAL_IO_PRINT("oam_upload_log_to_sdt::pc_string is null!\n");
return OAL_ERR_CODE_PTR_NULL;
}
pst_skb = oam_alloc_data2sdt(OAL_SIZEOF(oam_log_info_stru));
if (OAL_PTR_NULL == pst_skb)
{
return OAL_ERR_CODE_PTR_NULL;
}
/* COPY打印的内容 */
oal_memcopy(oal_netbuf_data(pst_skb), pc_string, OAL_SIZEOF(oam_log_info_stru));
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_skb, OAM_DATA_TYPE_LOG, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
/*****************************************************************************
函 数 名 : oam_stats_report_irq_info_to_sdt
功能描述 : 中断统计信息上报SDT
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年2月21日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_void oam_stats_report_irq_info_to_sdt(
oal_uint8 *puc_irq_info_addr,
oal_uint16 us_irq_info_len)
{
oal_uint32 ul_tick;
oal_uint16 us_skb_len; /* skb总长度 */
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return ;
}
if (OAL_PTR_NULL == puc_irq_info_addr)
{
OAL_IO_PRINT("oam_stats_report_irq_info_to_sdt::puc_irq_info_addr is null!\n");
return;
}
/* 为上报描述符申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_irq_info_len + OAL_SIZEOF(oam_ota_hdr_stru);
if (us_skb_len > WLAN_SDT_NETBUF_MAX_PAYLOAD)
{
us_skb_len = WLAN_SDT_NETBUF_MAX_PAYLOAD;
us_irq_info_len = WLAN_SDT_NETBUF_MAX_PAYLOAD - OAL_SIZEOF(oam_ota_hdr_stru);
}
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息头结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_IRQ;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_irq_info_len;
#if (_PRE_PRODUCT_ID == _PRE_PRODUCT_ID_HI1102_HOST)
pst_ota_data->st_ota_hdr.auc_resv[0] = 2;
#else
pst_ota_data->st_ota_hdr.auc_resv[0] = 3;
#endif
/* 复制数据,填写ota数据 */
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)puc_irq_info_addr,
(oal_uint32)us_irq_info_len);
/* 下发至sdt接收队列，若队列满则串口输出 */
oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
}
oal_bool_enum_uint8 hmac_protection_need_sync(mac_vap_stru *pst_mac_vap,
mac_h2d_protection_stru *pst_h2d_prot)
{
mac_h2d_protection_stru *pst_prot_old;
hmac_vap_stru *pst_hmac_vap;
mac_protection_stru *pst_old;
mac_protection_stru *pst_new;
pst_hmac_vap = (hmac_vap_stru *)mac_res_get_hmac_vap(pst_mac_vap->uc_vap_id);
if (OAL_PTR_NULL == pst_hmac_vap)
{
OAM_ERROR_LOG0(pst_mac_vap->uc_vap_id, OAM_SF_ANY,
"{hmac_protection_need_sync::null hmac_vap}");
return OAL_FALSE;
}
pst_prot_old = &pst_hmac_vap->st_prot;
if ( (pst_prot_old->en_dot11HTProtection != pst_h2d_prot->en_dot11HTProtection) ||
(pst_prot_old->en_dot11RIFSMode != pst_h2d_prot->en_dot11RIFSMode) ||
(pst_prot_old->en_dot11LSIGTXOPFullProtectionActivated != pst_h2d_prot->en_dot11LSIGTXOPFullProtectionActivated) ||
(pst_prot_old->en_dot11NonGFEntitiesPresent != pst_h2d_prot->en_dot11NonGFEntitiesPresent)
)
{
oal_memcopy(pst_prot_old, pst_h2d_prot, OAL_SIZEOF(mac_h2d_protection_stru));
return OAL_TRUE;
}
pst_old = &pst_prot_old->st_protection;
pst_new = &pst_h2d_prot->st_protection;
if ( (pst_old->en_protection_mode != pst_new->en_protection_mode) ||
(pst_old->bit_auto_protection != pst_new->bit_auto_protection) ||
(pst_old->bit_obss_non_erp_present != pst_new->bit_obss_non_erp_present) ||
(pst_old->bit_obss_non_ht_present != pst_new->bit_obss_non_ht_present) ||
(pst_old->bit_rts_cts_protect_mode != pst_new->bit_rts_cts_protect_mode) ||
(pst_old->bit_lsig_txop_protect_mode != pst_new->bit_lsig_txop_protect_mode) ||
(pst_old->uc_sta_non_ht_num != pst_new->uc_sta_non_ht_num)
)
{
oal_memcopy(pst_prot_old, pst_h2d_prot, OAL_SIZEOF(mac_h2d_protection_stru));
return OAL_TRUE;
}
return OAL_FALSE;
}
/*****************************************************************************
函 数 名 : oam_stats_report_usr_info
功能描述 : 把某个用户的统计信息上报sdt
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年3月24日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_stats_report_usr_info(oal_uint16 us_usr_id)
{
oal_uint32 ul_tick;
oal_uint16 us_skb_len; /* skb总长度 */
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint32 ul_ret = OAL_SUCC;
oal_uint16 us_stat_info_len;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
if (us_usr_id >= WLAN_DEVICE_SUPPORT_MAX_NUM_SPEC * WLAN_ACTIVE_USER_MAX_NUM)
{
return OAL_ERR_CODE_INVALID_CONFIG;
}
us_stat_info_len = OAL_SIZEOF(oam_device_stat_info_stru);
/* 为上报统计信息申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_stat_info_len + OAL_SIZEOF(oam_ota_hdr_stru);
if (us_skb_len > WLAN_SDT_NETBUF_MAX_PAYLOAD)
{
us_skb_len = WLAN_SDT_NETBUF_MAX_PAYLOAD;
us_stat_info_len = WLAN_SDT_NETBUF_MAX_PAYLOAD - OAL_SIZEOF(oam_ota_hdr_stru);
}
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息头结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_USER_STAT_INFO;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_stat_info_len;
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)&g_st_stat_info.ast_user_stat_info[us_usr_id],
us_stat_info_len);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
int32 hwifi_get_mac_addr(uint8 *puc_buf)
{
struct hisi_nve_info_user st_info;
int32 l_ret = -1;
int32 l_sum = 0;
if (NULL == puc_buf)
{
OAM_ERROR_LOG0(0, OAM_SF_ANY, "hisi_customize_wifi::buf is NULL!");
return INI_FAILED;
}
oal_memset(puc_buf, 0, MAC_LEN);
oal_memset(&st_info, 0, sizeof(st_info));
st_info.nv_number = NV_WLAN_NUM; //nve item
strncpy(st_info.nv_name, "MACWLAN", sizeof("MACWLAN"));
st_info.valid_size = NV_WLAN_VALID_SIZE;
st_info.nv_operation = NV_READ;
if (0 != g_auc_wifimac[0] || 0 != g_auc_wifimac[1] || 0 != g_auc_wifimac[2] || 0 != g_auc_wifimac[3]
|| 0 != g_auc_wifimac[4] || 0 != g_auc_wifimac[5])
{
memcpy(puc_buf, g_auc_wifimac, MAC_LEN);
return INI_SUCC;
}
l_ret = hisi_nve_direct_access(&st_info);
if (!l_ret)
{
l_sum = char2byte(st_info.nv_data, puc_buf);
if (0 != l_sum)
{
INI_WARNING("hisi_customize_wifi get MAC from NV: mac="MACFMT"\n", MAC2STR(puc_buf));
oal_memcopy(g_auc_wifimac, puc_buf, MAC_LEN);
}else{
random_ether_addr(puc_buf);
puc_buf[1] = 0x11;
puc_buf[2] = 0x02;
}
}else{
random_ether_addr(puc_buf);
puc_buf[1] = 0x11;
puc_buf[2] = 0x02;
}
return INI_SUCC;
}
/*****************************************************************************
函 数 名 : oam_netlink_kernel_send_ex
功能描述 : netlink消息发送函数(方向: 内核 -> host app)
输入参数 : puc_data_1st: 输入数据1
puc_data_2nd: 输入数据2
ul_len_1st : 数据长度1
ul_len_2nd : 数据长度2
en_type : netlink msg类型
输出参数 : 无
返 回 值 : 成功: 发送的字节数(netlink头 + payload + padding)
失败: 其它错误码
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2013年10月17日
作 者 : mayuan
修改内容 : 新生成函数
*****************************************************************************/
oal_int32 oam_netlink_kernel_send_ex(oal_uint8 *puc_data_1st, oal_uint8 *puc_data_2nd,
oal_uint32 ul_len_1st, oal_uint32 ul_len_2nd,
oam_nl_cmd_enum_uint8 en_type)
{
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,44))
/*TBD*/
return 0;
#else
oal_netbuf_stru *pst_netbuf;
oal_nlmsghdr_stru *pst_nlmsghdr;
oal_uint32 ul_size;
oal_int32 l_ret;
ul_size = OAL_NLMSG_SPACE(ul_len_1st + ul_len_2nd);
pst_netbuf = oal_netbuf_alloc(ul_size, 0, WLAN_MEM_NETBUF_ALIGN);
if (OAL_PTR_NULL == pst_netbuf)
{
return -1;
}
/* 初始化netlink消息首部 */
pst_nlmsghdr = oal_nlmsg_put(pst_netbuf, 0, 0, (oal_int32)en_type, (oal_int32)(ul_len_1st + ul_len_2nd), 0);
/* 设置控制字段 */
OAL_NETLINK_CB(pst_netbuf).pid = 0;
OAL_NETLINK_CB(pst_netbuf).dst_group = 0;
/* 填充数据区 */
oal_memcopy(OAL_NLMSG_DATA(pst_nlmsghdr), puc_data_1st, ul_len_1st);
oal_memcopy((oal_uint8 *)OAL_NLMSG_DATA(pst_nlmsghdr) + ul_len_1st, puc_data_2nd, ul_len_2nd);
/* 发送数据 */
l_ret = oal_netlink_unicast(g_st_netlink.pst_nlsk, pst_netbuf, g_st_netlink.ul_pid, OAL_MSG_DONTWAIT);
return l_ret;
#endif
}
/*****************************************************************************
函 数 名 : oam_report_vap_pkt_stat_to_sdt
功能描述 : 将某一个vap下的收发包统计信息上报sdt
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年7月10日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_report_vap_pkt_stat_to_sdt(oal_uint8 uc_vap_id)
{
oal_uint32 ul_tick;
oal_uint16 us_skb_len; /* skb总长度 */
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint32 ul_ret = OAL_SUCC;
oal_uint16 us_stat_info_len;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
us_stat_info_len = OAL_SIZEOF(oam_vap_stat_info_stru);
/* 为上报统计信息申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_stat_info_len + OAL_SIZEOF(oam_ota_hdr_stru);
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息头结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_VAP_STAT_INFO;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_stat_info_len;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
oal_set_mac_addr(pst_ota_data->st_ota_hdr.auc_user_macaddr, BROADCAST_MACADDR);
/* 复制数据,填写ota数据 */
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)&g_st_stat_info.ast_vap_stat_info[uc_vap_id],
us_stat_info_len);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
OAL_STATIC int32 hwifi_config_init_nvram(void)
{
int32 l_ret = INI_FAILED;
int32 l_cfg_id;
int32 aul_nvram_params[NVRAM_PARAMS_INDEX_BUTT]={0};
oal_memset(g_auc_nv_params, 0x00, sizeof(g_auc_nv_params));
l_ret = get_cust_conf_string(CUST_MODU_NVRAM, OAL_PTR_NULL, g_auc_nv_params, sizeof(g_auc_nv_params));
/* nv读取失败或者返回的参数值为零,尝试读取ini */
if(INI_FAILED == l_ret || !g_auc_nv_params[0])
{
OAM_WARNING_LOG3(0, OAM_SF_ANY, "hwifi_config_init_nvram read nvram failed[ret:%d] or wrong values[first eight values:0x%x %x], read dts instead!", l_ret, *((oal_uint32*)g_auc_nv_params),*((oal_uint32*)(g_auc_nv_params+4)));
/* 先尝试从ini文件中读取，读不到的话再从dts中读取 */
for (l_cfg_id = NVRAM_PARAMS_INDEX_0; l_cfg_id < NVRAM_PARAMS_INDEX_BUTT; l_cfg_id++)
{
l_ret = get_cust_conf_int32(INI_MODU_WIFI, g_ast_nvram_config_ini[l_cfg_id].name, &aul_nvram_params[l_cfg_id]);
if(INI_FAILED == l_ret)
{
OAM_ERROR_LOG1(0, OAM_SF_ANY, "hwifi_config_init_nvram read %d from ini failed!", l_cfg_id);
break;
}
}
if (NVRAM_PARAMS_INDEX_BUTT == l_cfg_id)
{
OAM_INFO_LOG0(0, OAM_SF_ANY, "hwifi_config_init_nvram read from ini success!");
oal_memcopy(g_auc_nv_params, aul_nvram_params, sizeof(g_auc_nv_params));
return INI_SUCC;
}
l_ret = get_cust_conf_string(CUST_MODU_DTS, NVRAM_PARAMS_ARRAY, g_auc_nv_params, sizeof(g_auc_nv_params));
if(INI_FAILED == l_ret)
{
OAM_WARNING_LOG0(0, OAM_SF_ANY, "hwifi_config_init_nvram read dts failed!");
/* 读取dts也失败时将数组置零，防止下发至device */
oal_memset(g_auc_nv_params, 0x00, sizeof(g_auc_nv_params));
return INI_FAILED;
}
}
return INI_SUCC;
}
OAL_STATIC oal_void dmac_alg_stat_init(dmac_device_stru *pst_dmac_device)
{
dmac_alg_stat_stru *pst_dmac_alg_stat = &pst_dmac_device->st_dmac_alg_stat;
oal_uint32 aul_compatibility_rate_limit[WLAN_BW_CAP_BUTT][WLAN_PROTOCOL_BUTT] = DMAC_COMPATIBILITY_RATE_LIMIT_TABLE;
pst_dmac_alg_stat->en_cca_intf_state = DMAC_ALG_CCA_OPT_NO_INTF;
pst_dmac_alg_stat->en_co_intf_state = OAL_FALSE;
pst_dmac_alg_stat->en_dmac_device_distance_enum = DMAC_ALG_TPC_NORMAL_DISTANCE;
pst_dmac_device->st_dmac_compatibility_stat.en_compatibility_enable = OAL_FALSE;
pst_dmac_device->st_dmac_compatibility_stat.en_compatibility_stat = OAL_FALSE;
pst_dmac_device->st_dmac_compatibility_stat.ul_rx_rate = 0;
pst_dmac_device->st_dmac_compatibility_stat.us_rx_rate_stat_count = 0;
oal_memcopy((oal_uint8*)pst_dmac_device->st_dmac_compatibility_stat.aul_compatibility_rate_limit,
(oal_uint8*)aul_compatibility_rate_limit,
OAL_SIZEOF(aul_compatibility_rate_limit));
return;
}
int32 hwifi_fetch_ori_caldata(uint8* auc_caldata, int32 l_nvm_len)
{
int32 l_ret = INI_FAILED;
int32 l_cfg_id;
int32 aul_nvram_params[NVRAM_PARAMS_INDEX_BUTT]={0};
if (l_nvm_len != HISI_CUST_NVRAM_LEN)
{
OAM_ERROR_LOG2(0, OAM_SF_ANY, "hwifi_fetch_ori_caldata atcmd[nv_len:%d] and plat_ini[nv_len:%d] model have different nvm lenth!!",
l_nvm_len, HISI_CUST_NVRAM_LEN);
return INI_FAILED;
}
oal_memset(auc_caldata, 0x00, HISI_CUST_NVRAM_LEN);
for (l_cfg_id = NVRAM_PARAMS_INDEX_0; l_cfg_id < NVRAM_PARAMS_INDEX_BUTT; l_cfg_id++)
{
l_ret = get_cust_conf_int32(INI_MODU_WIFI, g_ast_nvram_config_ini[l_cfg_id].name, &aul_nvram_params[l_cfg_id]);
if(INI_FAILED == l_ret)
{
OAM_ERROR_LOG1(0, OAM_SF_ANY, "hwifi_fetch_ori_caldata read ori caldata %d from ini failed!", l_cfg_id);
break;
}
}
if (NVRAM_PARAMS_INDEX_BUTT == l_cfg_id)
{
OAM_INFO_LOG0(0, OAM_SF_ANY, "hwifi_fetch_ori_caldata read ori caldata from ini success!");
oal_memcopy(auc_caldata, aul_nvram_params, HISI_CUST_NVRAM_LEN);
return INI_SUCC;
}
l_ret = get_cust_conf_string(CUST_MODU_DTS, NVRAM_PARAMS_ARRAY, auc_caldata, HISI_CUST_NVRAM_LEN);
if(INI_FAILED == l_ret)
{
OAM_ERROR_LOG0(0, OAM_SF_ANY, "hwifi_fetch_ori_caldata read ori caldata from dts failed!");
return INI_FAILED;
}
return INI_SUCC;
}
/*****************************************************************************
函 数 名 : oam_print_to_sdt
功能描述 : 打印信息到PC侧可维可测工具平台中
输入参数 : pc_string : 需要打印到可维可测工具平台中的字符串，以\0结束。
输出参数 : 无
返 回 值 : OAL_SUCC或其他错误码。
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年10月15日
作 者 : c59720
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_print_to_sdt(oal_int8 *pc_string)
{
oal_netbuf_stru *pst_skb;
oal_uint32 ul_ret = OAL_SUCC;
oal_uint16 us_strlen;
if (OAL_UNLIKELY(OAL_PTR_NULL == pc_string))
{
return OAL_ERR_CODE_PTR_NULL;
}
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
/* 上报sdt字符串以'0'结束 */
us_strlen = (oal_uint16)OAL_STRLEN(pc_string);
us_strlen = (us_strlen > OAM_REPORT_MAX_STRING_LEN) ? OAM_REPORT_MAX_STRING_LEN : us_strlen;
pst_skb = oam_alloc_data2sdt(us_strlen);
if (OAL_PTR_NULL == pst_skb)
{
return OAL_ERR_CODE_PTR_NULL;
}
/* COPY打印的内容 */
oal_memset(oal_netbuf_data(pst_skb), 0, us_strlen);
oal_memcopy(oal_netbuf_data(pst_skb), pc_string, (oal_uint32)us_strlen);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_skb, OAM_DATA_TYPE_STRING, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
/*****************************************************************************
函 数 名 : sdt_drv_send_data_to_wifi
功能描述 : 从app侧接收到数据，解析该数据的头部信息，确定是数据的去向，然后
调用相应的51驱动侧接口
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年1月27日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_int32 sdt_drv_send_data_to_wifi(oal_uint8 *puc_param, oal_int32 l_len)
{
oal_netbuf_stru *pst_netbuf;
oal_int8 *pc_buf;
oal_int i_len; /* SDIO CRC ERROR */
oal_int32 l_ret = OAL_EFAIL;
oal_uint8 *puc_data;
if (OAL_PTR_NULL == puc_param)
{
OAL_IO_PRINT("sdt_drv_send_data_to_wifi::puc_param is null!\n");
return -OAL_EFAIL;
}
i_len = (oal_int)l_len > 300 ? (oal_int)l_len: 300;
/* 接收消息不用填充头，直接使用 */
pst_netbuf = oal_mem_sdt_netbuf_alloc((oal_uint16)i_len, OAL_TRUE);
if (OAL_PTR_NULL == pst_netbuf)
{
return -OAL_EFAIL;
}
pc_buf = (oal_int8 *)oal_netbuf_put(pst_netbuf, (oal_uint32)l_len);
oal_memcopy((oal_void *)pc_buf, (const oal_void *)puc_param, (oal_uint32)l_len);
i_len = pc_buf[5]*MAX_NUM;
i_len = pc_buf[4] + i_len;
i_len = i_len - OAM_RESERVE_SKB_LEN;
puc_data = oal_netbuf_data(pst_netbuf);
switch(pc_buf[1])
{
case OAM_DATA_TYPE_MEM_RW:
if (OAL_PTR_NULL != g_st_oam_wal_func_hook.p_wal_recv_mem_data_func)
{
l_ret = g_st_oam_wal_func_hook.p_wal_recv_mem_data_func(&puc_data[8], (oal_uint16)i_len);
}
break;
case OAM_DATA_TYPE_REG_RW:
if (OAL_PTR_NULL != g_st_oam_wal_func_hook.p_wal_recv_reg_data_func)
{
l_ret = g_st_oam_wal_func_hook.p_wal_recv_reg_data_func(&puc_data[8], (oal_uint16)i_len);
}
break;
case OAM_DATA_TYPE_CFG:
if (OAL_PTR_NULL != g_st_oam_wal_func_hook.p_wal_recv_cfg_data_func)
{
l_ret = g_st_oam_wal_func_hook.p_wal_recv_cfg_data_func(&puc_data[8], (oal_uint16)i_len);
}
break;
case OAM_DATA_TYPE_GVAR_RW:
if (OAL_PTR_NULL != g_st_oam_wal_func_hook.p_wal_recv_global_var_func)
{
l_ret = g_st_oam_wal_func_hook.p_wal_recv_global_var_func(&puc_data[8], (oal_uint16)i_len);
}
break;
default:
OAL_IO_PRINT("sdt_drv_send_data_to_wifi::cmd is invalid!!-->%d\n", pc_buf[1]);
break;
}
#if (_PRE_OS_VERSION_RAW != _PRE_OS_VERSION)
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
#endif
//oal_netbuf_free(pst_netbuf);
return l_ret;
}
/*****************************************************************************
函 数 名 : dmac_device_init
功能描述 : device的初始化函数
输入参数 : 指向要进行初始化的device指针
输出参数 : 无
返 回 值 : 成功或者失败原因
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2012年10月19日
作 者 : huxiaotong
修改内容 : 新生成函数
*****************************************************************************/
OAL_STATIC oal_uint32 dmac_device_init(oal_uint8 *puc_device_id, oal_uint8 uc_chip_id, oal_uint8 uc_device_id, oal_uint32 ul_chip_ver)
{
oal_uint32 ul_ret;
oal_uint8 uc_dev_id;
mac_device_stru *pst_device;
mac_data_rate_stru *pst_data_rate;
oal_uint32 ul_rate_num = 0;
oal_uint32 ul_idx;
oal_uint32 ul_loop = 0;
dmac_device_stru *pst_dmac_device;
hal_cfg_rts_tx_param_stru st_hal_rts_tx_param;
#ifdef _PRE_WLAN_DFT_STAT
oam_stats_phy_node_idx_stru st_phy_node_idx = {{OAM_STATS_PHY_NODE_TX_CNT,
OAM_STATS_PHY_NODE_RX_OK_CNT,
OAM_STATS_PHY_NODE_11B_HDR_ERR_CNT,
OAM_STATS_PHY_NODE_OFDM_HDR_ERR_CNT}};
#endif
/*申请公共mac device结构体，修改下 名称*/
ul_ret = mac_res_alloc_dmac_dev(&uc_dev_id);
if(OAL_UNLIKELY(ul_ret != OAL_SUCC))
{
OAM_ERROR_LOG1(0, OAM_SF_ANY, "{dmac_device_init::mac_res_alloc_dmac_dev failed[%d].}", ul_ret);
return OAL_FAIL;
}
pst_device = mac_res_get_dev(uc_dev_id);
if (OAL_PTR_NULL == pst_device)
{
OAM_ERROR_LOG0(0, OAM_SF_ANY, "{dmac_device_init::pst_device null.}");
return OAL_ERR_CODE_PTR_NULL;
}
#if 0
pst_device->uc_chip_id = uc_chip_id;
pst_device->uc_device_id = uc_dev_id;
#endif
/* 申请dmac device资源 */
if(OAL_UNLIKELY(dmac_res_alloc_mac_dev(uc_dev_id) != OAL_SUCC))
{
OAM_ERROR_LOG0(0, OAM_SF_ANY, "{dmac_device_init::dmac_res_alloc_mac_dev failed.}");
return OAL_FAIL;
}
#if (_PRE_MULTI_CORE_MODE_OFFLOAD_DMAC == _PRE_MULTI_CORE_MODE)
/* 初始化device级别的一些参数 */
ul_ret = mac_device_init(pst_device, ul_chip_ver, uc_chip_id, uc_dev_id);
if (OAL_SUCC != ul_ret)
{
OAM_ERROR_LOG2(0, OAM_SF_ANY, "{dmac_device_init::mac_device_init failed[%d], chip_ver[0x%x].}", ul_ret, ul_chip_ver);
dmac_res_free_mac_dev(uc_dev_id);
mac_res_free_dev(uc_dev_id);
return ul_ret;
}
#endif
/* 获取hmac device，并进行相关参数赋值 */
pst_dmac_device = dmac_res_get_mac_dev(uc_dev_id);
if (OAL_PTR_NULL == pst_dmac_device)
{
OAM_ERROR_LOG0(0, OAM_SF_ANY, "{dmac_device_init::pst_dmac_device null.}");
mac_res_free_dev(uc_dev_id);
return OAL_ERR_CODE_PTR_NULL;
}
/* 结构体初始化 */
OAL_MEMZERO(pst_dmac_device, OAL_SIZEOF(*pst_dmac_device));
pst_dmac_device->pst_device_base_info = pst_device;
#ifdef _PRE_WLAN_FEATURE_DFR
pst_dmac_device->en_dfr_hw_reset_enable = OAL_FALSE;
#endif //#ifdef _PRE_WLAN_FEATURE_DFR
/* 硬mac结构指针只存在于DMAC中，需要针对device对象中私有部分
的内容进行初始化，用于逻辑和物理device的对应 */
ul_ret = hal_chip_get_device(uc_chip_id, uc_device_id, &pst_device->pst_device_stru);
pst_device->ul_core_id = pst_device->pst_device_stru->ul_core_id;
if (OAL_SUCC != ul_ret)
{
OAM_WARNING_LOG1(0, OAM_SF_ANY, "{dmac_device_init::hal_chip_get_device failed[%d].}", ul_ret);
dmac_res_free_mac_dev(uc_dev_id);
mac_res_free_dev(uc_dev_id);
return ul_ret;
}
/* 保存mac层的device id */
pst_device->pst_device_stru->uc_mac_device_id = uc_dev_id;
if(OAL_SUCC != mac_fcs_init(&pst_device->st_fcs_mgr, pst_device->uc_chip_id, pst_device->uc_device_id))
{
OAM_WARNING_LOG0(0, OAM_SF_ANY, "{dmac_device_init::mac_fcs_init failed.}");
dmac_res_free_mac_dev(uc_dev_id);
mac_res_free_dev(uc_dev_id);
return OAL_FAIL;
}
/* 算法框架初始化 */
ul_ret = dmac_alg_init(pst_device);
if (OAL_SUCC != ul_ret)
{
OAM_WARNING_LOG1(0, OAM_SF_ANY, "{dmac_device_init::dmac_alg_init failed[%d].}", ul_ret);
dmac_res_free_mac_dev(uc_dev_id);
mac_res_free_dev(uc_dev_id);
return ul_ret;
}
/* 算法距离、干扰等状态初始化 */
dmac_alg_stat_init(pst_dmac_device);
pst_device->us_total_mpdu_num = 0;
/* 错误计数初始化 */
OAL_MEMZERO(pst_device->aul_mac_err_cnt, OAL_SIZEOF(pst_device->aul_mac_err_cnt));
/*初始化记录性能统计第一次时间戳*/
pst_device->ul_first_timestamp = 0;
pst_device->ul_rx_buf_too_small_show_counter = 0;
#if (_PRE_PRODUCT_ID == _PRE_PRODUCT_ID_HI1151)
pst_device->ul_rx_fsm_st_timeout_show_counter = 0;
pst_device->ul_tx_fsm_st_timeout_show_counter = 0;
pst_device->ul_beacon_miss_show_counter = 0;
pst_device->us_user_nums_max = WLAN_ASSOC_USER_MAX_NUM_SPEC;
pst_device->ul_pcie_reg110_timeout_counter = 0;
pst_device->ul_pcie_read_counter = 0;
/* DTS2015100700205,特殊网卡兼容性问题规避方案: 会发生DataFlow Break时候会影响性能 */
pst_device->st_dataflow_brk_bypass.en_brk_limit_aggr_enable = OAL_FALSE;
pst_device->st_dataflow_brk_bypass.ul_tx_dataflow_brk_cnt = 0;
pst_device->st_dataflow_brk_bypass.ul_last_tx_complete_isr_cnt = 0;
#endif
for (ul_loop = 0; ul_loop < WLAN_WME_AC_BUTT; ul_loop++)
{
pst_device->aus_ac_mpdu_num[ul_loop] = 0;
}
for (ul_loop = 0; ul_loop < WLAN_VAP_SUPPORT_MAX_NUM_LIMIT; ul_loop++)
{
pst_device->aus_vap_mpdu_num[ul_loop] = 0;
}
for (ul_loop = WLAN_WME_AC_BE; ul_loop < WLAN_WME_AC_BUTT; ul_loop++)
{
pst_device->aus_ac_mpdu_num[ul_loop] = 0;
}
#ifdef _PRE_WLAN_DFT_STAT
/* 初始化维测参数，空口环境类参数 */
OAL_MEMZERO(&(pst_device->st_dbb_env_param_ctx), OAL_SIZEOF(mac_device_dbb_env_param_ctx_stru));
#endif
#ifdef _PRE_WLAN_FEATURE_PM
pst_device->en_pm_enable = OAL_FALSE;
mac_pm_arbiter_init(pst_device);
#endif
/* 初始化TXOP特性相关值 */
pst_device->en_txop_enable = OAL_FALSE;
pst_device->uc_tx_ba_num = 0;
/* 从eeprom或flash获得MAC地址 */
hal_get_hw_addr(pst_device->pst_device_stru, pst_device->auc_hw_addr);
/* 初始化DEVICE下的速率集 */
hal_get_rate_80211g_table(pst_device->pst_device_stru, (oal_void *)&pst_data_rate);
hal_get_rate_80211g_num(pst_device->pst_device_stru, &ul_rate_num);
for (ul_idx = 0; ul_idx < ul_rate_num; ul_idx++)
{
oal_memcopy(&(pst_device->st_mac_rates_11g[ul_idx]),&pst_data_rate[ul_idx],OAL_SIZEOF(mac_data_rate_stru));
}
/* 初始化2.4G和5G的RTS速率, RTS[0~2]设为24Mbps, RTS[3]在2.4G设为1Mbps、5G设为24Mbps*/
st_hal_rts_tx_param.auc_protocol_mode[0] = WLAN_LEGACY_OFDM_PHY_PROTOCOL_MODE;
st_hal_rts_tx_param.auc_rate[0] = WLAN_LEGACY_OFDM_24M_BPS;
st_hal_rts_tx_param.auc_protocol_mode[1] = WLAN_LEGACY_OFDM_PHY_PROTOCOL_MODE;
st_hal_rts_tx_param.auc_rate[1] = WLAN_LEGACY_OFDM_24M_BPS;
st_hal_rts_tx_param.auc_protocol_mode[2] = WLAN_LEGACY_OFDM_PHY_PROTOCOL_MODE;
st_hal_rts_tx_param.auc_rate[2] = WLAN_LEGACY_OFDM_24M_BPS;
st_hal_rts_tx_param.en_band = WLAN_BAND_2G;
st_hal_rts_tx_param.auc_protocol_mode[3] = WLAN_11B_PHY_PROTOCOL_MODE;
st_hal_rts_tx_param.auc_rate[3] = WLAN_LONG_11b_1_M_BPS;
hal_set_rts_rate_params(pst_device->pst_device_stru, &st_hal_rts_tx_param);
st_hal_rts_tx_param.en_band = WLAN_BAND_5G;
st_hal_rts_tx_param.auc_protocol_mode[3] = WLAN_LEGACY_OFDM_PHY_PROTOCOL_MODE;
st_hal_rts_tx_param.auc_rate[3] = WLAN_LEGACY_OFDM_24M_BPS;
hal_set_rts_rate_params(pst_device->pst_device_stru, &st_hal_rts_tx_param);
#if (_PRE_OS_VERSION_LINUX == _PRE_OS_VERSION)||(_PRE_OS_VERSION_RAW == _PRE_OS_VERSION)
/* TBD */
/* hal_enable_radar_det(pst_device->pst_device_stru, OAL_TRUE); */
pst_device->us_dfs_timeout = 0;
#endif
/* 初始化DMAC SCANNER */
dmac_scan_init(pst_device);
#ifdef _PRE_SUPPORT_ACS
/* 初始化ACS结构体 */
dmac_acs_init(pst_device);
#endif
#ifdef _PRE_WLAN_DFT_REG
/* 初始化寄存器读取定时器 */
FRW_TIMER_CREATE_TIMER(&pst_device->st_reg_prd_timer,
dmac_reg_timeout,
OAM_REGSTER_REFRESH_TIME_MS,
pst_device->pst_device_stru,
OAL_TRUE,
OAM_MODULE_ID_DMAC,
pst_device->ul_core_id);
#endif
/* 出参赋值，CHIP中需要保存该device id */
*puc_device_id = uc_dev_id;
#ifdef _PRE_WLAN_FEATURE_AMPDU
#ifdef _PRE_DEBUG_MODE
//#if ((_PRE_TARGET_PRODUCT_TYPE_5610DMB != _PRE_CONFIG_TARGET_PRODUCT) )
//OAL_MEMZERO(g_ast_tx_ba_track[pst_device->uc_device_id], OAL_SIZEOF(dmac_tx_ba_track_stru) * HAL_MAX_AMPDU_LUT_SIZE);
//#endif
#endif
#endif
#ifdef _PRE_DEBUG_MODE
OAL_MEMZERO(&(pst_device->st_exception_report_timer), OAL_SIZEOF(frw_timeout_stru));
FRW_TIMER_CREATE_TIMER(&(pst_device->st_exception_report_timer),
dmac_device_exception_report_timeout_fn,
MAC_EXCEPTION_TIME_OUT,
pst_device->pst_device_stru,
OAL_TRUE,
OAM_MODULE_ID_MAC,
pst_device->ul_core_id);
#endif
#ifdef _PRE_WLAN_DFT_STAT
/* 初始化phy统计节点 */
dmac_dft_set_phy_stat_node(pst_device, &st_phy_node_idx);
#endif
ul_ret = dmac_cfg_vap_init(pst_device);
if(OAL_UNLIKELY(ul_ret != OAL_SUCC))
{
OAM_ERROR_LOG1(0, OAM_SF_ANY, "{hmac_chip_init::hmac_cfg_vap_init failed[%d].}", ul_ret);
return OAL_FAIL;
}
return OAL_SUCC;
}
/*****************************************************************************
函 数 名 : hmac_smps_update_status
功能描述 : AP侧接收到对应STA的关联请求消息
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年4月16日
作 者 : zhangyu
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 hmac_smps_update_status(mac_vap_stru *pst_mac_vap, mac_user_stru *pst_mac_user, oal_bool_enum_uint8 en_plus_user)
{
mac_device_stru *pst_mac_device;
wlan_mib_mimo_power_save_enum_uint8 en_user_smps_mode;
frw_event_mem_stru *pst_event_mem;
frw_event_stru *pst_event;
oal_uint32 ul_ret;
oal_bool_enum_uint8 en_ht_cap;
mac_cfg_smps_mode_stru st_smps_mode = {0};
if ((OAL_PTR_NULL == pst_mac_vap) || (OAL_PTR_NULL == pst_mac_user))
{
OAM_ERROR_LOG2(0, OAM_SF_SMPS, "{hmac_smps_update_status: NULL PTR pst_mac_vap is [%d] and pst_mac_user is [%d].}", pst_mac_vap, pst_mac_user);
return OAL_ERR_CODE_PTR_NULL;
}
if (OAL_FALSE == mac_mib_get_HighThroughputOptionImplemented(pst_mac_vap))
{
OAM_INFO_LOG0(pst_mac_vap->uc_vap_id, OAM_SF_SMPS, "{hmac_smps_update_status: pst_mac_vap is mimo.}");
return OAL_SUCC;
}
pst_mac_device = mac_res_get_dev(pst_mac_vap->uc_device_id);
if (OAL_PTR_NULL == pst_mac_device)
{
OAM_ERROR_LOG0(pst_mac_vap->uc_vap_id, OAM_SF_SMPS, "{hmac_smps_update_status: pst_mac_device is null.}");
return OAL_ERR_CODE_PTR_NULL;
}
st_smps_mode.uc_smps_mode = WLAN_MIB_MIMO_POWER_SAVE_BUTT;
st_smps_mode.us_user_idx = 0;
en_user_smps_mode = (wlan_mib_mimo_power_save_enum_uint8)pst_mac_user->st_ht_hdl.bit_sm_power_save;
en_ht_cap = (oal_bool_enum_uint8)pst_mac_user->st_ht_hdl.en_ht_capable;
if (OAL_TRUE == en_plus_user)
{
if ((OAL_TRUE == en_ht_cap) && (WLAN_MIB_MIMO_POWER_SAVE_MIMO != en_user_smps_mode))
{
/* 如果不是第一个用户，则直接返回 */
if (1 < pst_mac_device->uc_asoc_user_cnt)
{
return OAL_SUCC;
}
/* 如果是第一个用户，则进入SMPS模式 */
/* 设置SMPS模式信息 mib值 */
st_smps_mode.uc_smps_mode = (oal_uint8)pst_mac_vap->st_cap_flag.bit_smps;
}
else
{
pst_mac_device->uc_no_smps_user_cnt++;
if (OAL_FALSE == pst_mac_device->en_smps)
{
return OAL_SUCC;
}
/* 设置SMPS模式disable */
st_smps_mode.uc_smps_mode = WLAN_MIB_MIMO_POWER_SAVE_MIMO;
hmac_smps_all_vap_update(pst_mac_device, WLAN_MIB_MIMO_POWER_SAVE_MIMO);
}
}
else
{
if ((OAL_TRUE == en_ht_cap) && (WLAN_MIB_MIMO_POWER_SAVE_MIMO != en_user_smps_mode))
{
return OAL_SUCC;
}
if (0 < pst_mac_device->uc_no_smps_user_cnt)
{
pst_mac_device->uc_no_smps_user_cnt--;
}
if ((0 == pst_mac_device->uc_no_smps_user_cnt) && (OAL_FALSE == pst_mac_device->en_smps))
{
/* 设置SMPS模式信息 mib值 */
st_smps_mode.uc_smps_mode = mac_mib_get_smps(pst_mac_vap);
hmac_smps_all_vap_update(pst_mac_device, mac_mib_get_smps(pst_mac_vap));
}
else
{
return OAL_SUCC;
}
}
/* 抛事件到DMAC, 申请事件内存 */
pst_event_mem = FRW_EVENT_ALLOC(OAL_SIZEOF(st_smps_mode));
if (OAL_PTR_NULL == pst_event_mem)
{
OAM_ERROR_LOG0(pst_mac_vap->uc_vap_id, OAM_SF_SMPS, "{hmac_smps_update_status: FRW_EVENT_ALLOC fail.}");
return OAL_ERR_CODE_PTR_NULL;
}
ul_ret = mac_vap_find_user_by_macaddr(pst_mac_vap, pst_mac_user->auc_user_mac_addr, &(st_smps_mode.us_user_idx));
/* 查找用户失败或没有找到对应的用户 */
if (OAL_SUCC != ul_ret)
{
OAM_WARNING_LOG1(pst_mac_vap->uc_vap_id, OAM_SF_SMPS, "{hmac_smps_update_status::mac_vap_find_user_by_macaddr failed[%d].}", ul_ret);
return ul_ret;
}
/* 填写事件 */
pst_event = (frw_event_stru *)pst_event_mem->puc_data;
FRW_EVENT_HDR_INIT(&(pst_event->st_event_hdr),
FRW_EVENT_TYPE_WLAN_CTX,
DMAC_WLAN_CTX_EVENT_SUB_TYPE_SET_SMPS,
OAL_SIZEOF(st_smps_mode),
FRW_EVENT_PIPELINE_STAGE_1,
pst_mac_vap->uc_chip_id,
pst_mac_vap->uc_device_id,
pst_mac_vap->uc_vap_id);
/* 拷贝参数 */
oal_memcopy(pst_event->auc_event_data, (oal_void *)&st_smps_mode, OAL_SIZEOF(st_smps_mode));
/* 分发事件 */
ul_ret = frw_event_dispatch_event(pst_event_mem);
if (OAL_SUCC != ul_ret)
{
FRW_EVENT_FREE(pst_event_mem);
return OAL_FAIL;
}
FRW_EVENT_FREE(pst_event_mem);
return OAL_SUCC;
}
/*****************************************************************************
函 数 名 : oam_stats_report_timer_info_to_sdt
功能描述 : 将软件定时器的信息上报SDT
输入参数 : puc_timer_addr:定时器结构的地址
uc_timer_len :定时器结构的长度
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年2月21日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_stats_report_timer_info_to_sdt(
oal_uint8 *puc_timer_addr,
oal_uint8 uc_timer_len)
{
oal_uint32 ul_ret = OAL_SUCC;
if (NULL != puc_timer_addr)
{
ul_ret = oam_ota_report(puc_timer_addr, uc_timer_len, 0, 0, OAM_OTA_TYPE_TIMER);
return ul_ret;
}
else
{
OAL_IO_PRINT("oam_stats_report_timer_info_to_sdt::puc_timer_addr is NULL");
return OAL_ERR_CODE_PTR_NULL;
}
#if 0
oal_uint32 ul_tick;
oal_uint16 us_skb_len; /* skb总长度 */
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint32 ul_ret = OAL_SUCC;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
if (OAL_PTR_NULL == puc_timer_addr)
{
OAL_IO_PRINT("oam_stats_report_timer_info_to_sdt::puc_timer_addr is null!\n");
return OAL_ERR_CODE_PTR_NULL;
}
if (OAM_TIMER_MAX_LEN < uc_timer_len)
{
OAL_IO_PRINT("oam_stats_report_timer_info_to_sdt::uc_timer_len-->%d\n",
uc_timer_len);
return OAL_FAIL;
}
/* 为上报描述符申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = uc_timer_len + OAL_SIZEOF(oam_ota_hdr_stru);
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息头结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_TIMER;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
pst_ota_data->st_ota_hdr.us_ota_data_len = uc_timer_len;
/* 复制数据,填写ota数据 */
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)puc_timer_addr,
(oal_uint32)uc_timer_len);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
#endif
}
OAL_STATIC oal_uint32 hmac_frag_process(hmac_vap_stru *pst_hmac_vap,
oal_netbuf_stru *pst_netbuf_original,
mac_tx_ctl_stru *pst_tx_ctl,
oal_uint32 ul_cip_hdrsize,
oal_uint32 ul_max_tx_unit)
{
mac_ieee80211_frame_stru *pst_mac_header;
mac_ieee80211_frame_stru *pst_frag_header;
oal_netbuf_stru *pst_netbuf;
oal_netbuf_stru *pst_netbuf_prev;
oal_uint32 ul_total_hdrsize;
oal_uint32 ul_frag_num;
oal_uint32 ul_frag_size;
oal_int32 l_remainder;
oal_uint32 ul_payload = 0;
oal_uint32 ul_offset;
mac_tx_ctl_stru *pst_tx_ctl_copy;
oal_uint32 ul_mac_hdr_size;
ul_mac_hdr_size = MAC_80211_QOS_HTC_4ADDR_FRAME_LEN;
pst_mac_header = pst_tx_ctl->pst_frame_header;
pst_mac_header->st_frame_control.bit_more_frag = OAL_TRUE;
ul_total_hdrsize = ul_mac_hdr_size + ul_cip_hdrsize;
ul_frag_num = 1;
/* 加密字节数包含在分片门限中，预留加密字节长度，由硬件填写加密头 */
ul_offset = ul_max_tx_unit - ul_cip_hdrsize - ul_mac_hdr_size;
l_remainder = (oal_int32)(OAL_NETBUF_LEN(pst_netbuf_original) - ul_offset - ul_mac_hdr_size);
pst_netbuf_prev = pst_netbuf_original;
do
{
ul_frag_size = ul_total_hdrsize + (oal_uint32)l_remainder;
/* 判断是否还有更多的分片 */
if (ul_frag_size > ul_max_tx_unit)
{
ul_frag_size = ul_max_tx_unit;
}
pst_netbuf = oal_netbuf_alloc(ul_frag_size + MAC_80211_QOS_HTC_4ADDR_FRAME_LEN, MAC_80211_QOS_HTC_4ADDR_FRAME_LEN, 4);
if (OAL_PTR_NULL == pst_netbuf)
{
/* 在外部释放之前申请的报文 */
OAM_ERROR_LOG0(pst_hmac_vap->st_vap_base_info.uc_vap_id, OAM_SF_ANY, "{hmac_frag_process::pst_netbuf null.}");
return OAL_ERR_CODE_PTR_NULL;
}
pst_tx_ctl_copy = (mac_tx_ctl_stru *)OAL_NETBUF_CB(pst_netbuf);
/* 拷贝cb字段 */
oal_memcopy(pst_tx_ctl_copy, pst_tx_ctl, MAC_TX_CTL_SIZE);
oal_netbuf_copy_queue_mapping(pst_netbuf, pst_netbuf_original);
/*netbuf的headroom大于802.11 mac头长度*/
pst_frag_header = (mac_ieee80211_frame_stru *)(OAL_NETBUF_PAYLOAD(pst_netbuf)- MAC_80211_QOS_HTC_4ADDR_FRAME_LEN);
pst_tx_ctl_copy->bit_80211_mac_head_type = 1; /*指示mac头部在skb中*/
/* 拷贝帧头内容 */
oal_memcopy(pst_frag_header, pst_mac_header, pst_tx_ctl->uc_frame_header_length);
/* 赋值分片号 */
pst_frag_header->bit_frag_num = ul_frag_num;
ul_frag_num++;
/* 计算分片报文帧体长度 */
ul_payload = ul_frag_size - ul_total_hdrsize;
oal_netbuf_copydata(pst_netbuf_original, (ul_offset+ul_mac_hdr_size), OAL_NETBUF_PAYLOAD(pst_netbuf), ul_payload);
oal_netbuf_set_len(pst_netbuf, ul_payload);
((mac_tx_ctl_stru *)OAL_NETBUF_CB(pst_netbuf))->pst_frame_header = pst_frag_header;
((mac_tx_ctl_stru *)OAL_NETBUF_CB(pst_netbuf))->us_mpdu_len = (oal_uint16)ul_payload;
OAL_NETBUF_NEXT(pst_netbuf_prev) = pst_netbuf;
pst_netbuf_prev = pst_netbuf;
if (pst_tx_ctl_copy->bit_80211_mac_head_type == 1)
{
oal_netbuf_push(pst_netbuf, MAC_80211_QOS_HTC_4ADDR_FRAME_LEN);
}
/* 计算下一个分片报文的长度和偏移 */
l_remainder -= (oal_int32)ul_payload;
ul_offset += ul_payload;
}while(l_remainder > 0);
pst_frag_header->st_frame_control.bit_more_frag = OAL_FALSE;
OAL_NETBUF_NEXT(pst_netbuf) = OAL_PTR_NULL;
/* 原始报文作为分片报文的第一个 */
oal_netbuf_trim(pst_netbuf_original, OAL_NETBUF_LEN(pst_netbuf_original) - (ul_max_tx_unit - ul_cip_hdrsize));
pst_tx_ctl->us_mpdu_len = (oal_uint16)(OAL_NETBUF_LEN(pst_netbuf_original) - ul_mac_hdr_size);
return OAL_SUCC;
}
oal_netbuf_stru* hmac_defrag_process(hmac_user_stru *pst_hmac_user, oal_netbuf_stru *pst_netbuf, oal_uint32 ul_hrdsize)
{
mac_ieee80211_frame_stru *pst_mac_hdr = OAL_PTR_NULL;
mac_ieee80211_frame_stru *pst_last_hdr = OAL_PTR_NULL;
oal_uint16 us_rx_seq = 0;
oal_uint16 us_last_seq = 0;
oal_uint8 uc_frag_num = 0;
oal_uint8 uc_last_frag_num = 0;
oal_bool_enum_uint8 en_more_frag = OAL_FALSE;
oal_netbuf_stru *pst_new_buf = OAL_PTR_NULL;
mac_rx_ctl_stru *pst_rx_ctl;
oal_uint32 ul_ret;
oal_uint8 uc_device_id;
mac_device_stru *pst_mac_device;
oal_uint32 ul_core_id;
pst_mac_hdr = (mac_ieee80211_frame_stru *)oal_netbuf_data(pst_netbuf);
us_rx_seq = pst_mac_hdr->bit_seq_num;
uc_frag_num = (oal_uint8)pst_mac_hdr->bit_frag_num;
en_more_frag = (oal_bool_enum_uint8)pst_mac_hdr->st_frame_control.bit_more_frag;
/* 如果没有什么可以去分片的则直接返回 */
if (!en_more_frag && 0 == uc_frag_num && OAL_PTR_NULL == pst_hmac_user->pst_defrag_netbuf)
{
return pst_netbuf;
}
OAL_MEM_NETBUF_TRACE(pst_netbuf, OAL_FALSE);
/* 首先检查到来的分片报文是不是属于正在重组的分片报文 */
if (pst_hmac_user->pst_defrag_netbuf)
{
frw_timer_restart_timer(&pst_hmac_user->st_defrag_timer, HMAC_FRAG_TIMEOUT, OAL_FALSE);
pst_last_hdr = (mac_ieee80211_frame_stru *)oal_netbuf_data(pst_hmac_user->pst_defrag_netbuf);
us_last_seq = pst_last_hdr->bit_seq_num;
uc_last_frag_num = (oal_uint8)pst_last_hdr->bit_frag_num;
/* 如果地址不匹配，序列号不匹配，分片号不匹配则释放现在正在重组的报文 */
if (us_rx_seq != us_last_seq ||
uc_frag_num != (uc_last_frag_num + 1) ||
oal_compare_mac_addr(pst_last_hdr->auc_address1, pst_mac_hdr->auc_address1) ||
oal_compare_mac_addr(pst_last_hdr->auc_address2, pst_mac_hdr->auc_address2))
{
oal_netbuf_free(pst_hmac_user->pst_defrag_netbuf);
FRW_TIMER_IMMEDIATE_DESTROY_TIMER(&pst_hmac_user->st_defrag_timer);
pst_hmac_user->pst_defrag_netbuf = OAL_PTR_NULL;
}
}
/* 判断到来的分片报文是否是第一个分片 */
if (OAL_PTR_NULL == pst_hmac_user->pst_defrag_netbuf)
{
/* 首片分片的分片号不为0则释放 */
if (uc_frag_num != 0)
{
oal_netbuf_free(pst_netbuf);
OAM_STAT_VAP_INCR(pst_hmac_user->st_user_base_info.uc_vap_id, rx_defrag_process_dropped, 1);
OAM_INFO_LOG3(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY,
"{hmac_defrag_process::The first frag_num is not Zero(%d), seq_num[%d], mor_frag[%d].}",
uc_frag_num, us_rx_seq, en_more_frag);
return OAL_PTR_NULL;
}
/* 没有分片,直接返回 */
if (0 == en_more_frag && 0 == uc_frag_num)
{
return pst_netbuf;
}
uc_device_id = pst_hmac_user->st_user_base_info.uc_device_id;
pst_mac_device = mac_res_get_dev((oal_uint32)uc_device_id);
if (OAL_PTR_NULL == pst_mac_device)
{
OAM_ERROR_LOG4(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY,
"{hmac_defrag_process::user index[%d] user mac:XX:XX:XX:%02X:%02X:%02X}",
pst_hmac_user->st_user_base_info.us_assoc_id,
pst_hmac_user->st_user_base_info.auc_user_mac_addr[3],
pst_hmac_user->st_user_base_info.auc_user_mac_addr[4],
pst_hmac_user->st_user_base_info.auc_user_mac_addr[5]);
/* user异常，丢弃报文 */
oal_netbuf_free(pst_netbuf);
OAM_STAT_VAP_INCR(pst_hmac_user->st_user_base_info.uc_vap_id, rx_defrag_process_dropped, 1);
return OAL_PTR_NULL;
}
ul_core_id = pst_mac_device->ul_core_id;
/* 启动超时定时器，超时释放重组报文 */
FRW_TIMER_CREATE_TIMER(&pst_hmac_user->st_defrag_timer,
hmac_defrag_timeout_fn,
HMAC_FRAG_TIMEOUT,
pst_hmac_user,
OAL_FALSE,
OAM_MODULE_ID_HMAC,
ul_core_id);
/* 内存池netbuf只有1600 可能不够，参照A公司申请2500操作系统原生态报文 */
pst_new_buf = OAL_MEM_NETBUF_ALLOC(OAL_NORMAL_NETBUF, HMAC_MAX_FRAG_SIZE, OAL_NETBUF_PRIORITY_MID);
if (OAL_PTR_NULL == pst_new_buf)
{
OAM_ERROR_LOG1(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY, "{hmac_defrag_process::Alloc new_buf null,size[%d].}", HMAC_MAX_FRAG_SIZE);
return OAL_PTR_NULL;
}
OAL_MEM_NETBUF_TRACE(pst_new_buf, OAL_FALSE);
/* 将分片报文拷贝到新申请的报文中并挂接到用户结构体下，释放原有的报文 */
oal_netbuf_init(pst_new_buf, OAL_NETBUF_LEN(pst_netbuf));
oal_netbuf_copydata(pst_netbuf, 0, oal_netbuf_data(pst_new_buf), OAL_NETBUF_LEN(pst_netbuf));
oal_memcopy(OAL_NETBUF_CB(pst_new_buf), OAL_NETBUF_CB(pst_netbuf), MAC_TX_CTL_SIZE);
pst_rx_ctl = (mac_rx_ctl_stru *)OAL_NETBUF_CB(pst_new_buf);
pst_rx_ctl->pul_mac_hdr_start_addr = (oal_uint32 *)OAL_NETBUF_HEADER(pst_new_buf);
pst_hmac_user->pst_defrag_netbuf = pst_new_buf;
oal_netbuf_free(pst_netbuf);
pst_netbuf = pst_new_buf;
}
else
{
if (OAL_UNLIKELY(OAL_PTR_NULL == pst_last_hdr))
{
OAM_ERROR_LOG0(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY, "{hmac_defrag_process::pst_last_hdr is NULL.}");
return OAL_PTR_NULL;
}
/* 此分片是期望的到来的分片，重启定时器，并进行重组 */
frw_timer_restart_timer(&pst_hmac_user->st_defrag_timer, HMAC_FRAG_TIMEOUT, OAL_FALSE);
oal_netbuf_pull(pst_netbuf, ul_hrdsize);
/* 记录最新分片报文的分片号 */
pst_last_hdr->bit_seq_num = pst_mac_hdr->bit_seq_num;
pst_last_hdr->bit_frag_num = pst_mac_hdr->bit_frag_num;
/*此接口内会调用dev_kfree_skb*/
oal_netbuf_concat(pst_hmac_user->pst_defrag_netbuf, pst_netbuf);
}
/* 判断是否重组完毕，存在更多报文返回空指针，重组完毕返回组好的报文 */
if (en_more_frag)
{
pst_netbuf = OAL_PTR_NULL;
}
else
{
if (OAL_UNLIKELY(OAL_PTR_NULL == pst_last_hdr))
{
OAM_ERROR_LOG0(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY, "{hmac_defrag_process::pst_last_hdr is NULL.}");
oal_netbuf_free(pst_netbuf);
pst_hmac_user->pst_defrag_netbuf = OAL_PTR_NULL;
return OAL_PTR_NULL;
}
pst_netbuf = pst_hmac_user->pst_defrag_netbuf;
/* 对重组好的报文进行mic检查 */
ul_ret = hmac_de_mic(pst_hmac_user, pst_netbuf);
if (OAL_SUCC != ul_ret)
{
oal_netbuf_free(pst_netbuf);
OAM_STAT_VAP_INCR(pst_hmac_user->st_user_base_info.uc_vap_id, rx_de_mic_fail_dropped, 1);
pst_netbuf = OAL_PTR_NULL;
OAM_INFO_LOG1(pst_hmac_user->st_user_base_info.uc_vap_id, OAM_SF_ANY, "{hmac_defrag_process::hmac_de_mic failed[%d].}", ul_ret);
}
pst_hmac_user->pst_defrag_netbuf = OAL_PTR_NULL;
pst_last_hdr->bit_frag_num = 0;
FRW_TIMER_IMMEDIATE_DESTROY_TIMER(&pst_hmac_user->st_defrag_timer);
}
return pst_netbuf;
}
/*****************************************************************************
函 数 名 : oam_stats_report_mempool_info_to_sdt
功能描述 : 将内存池的某一个子池内存块的使用情况上报sdt
输入参数 : uc_pool_id :内存池id
us_pool_total_cnt :本内存池一共多少内存块
us_pool_used_cnt :本内存池已用内存块
uc_subpool_id :子池id
us_subpool_total_cnt :本子池内存块总数
us_subpool_free_cnt :本子池可用内存块个数
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年2月21日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_stats_report_mempool_info_to_sdt(
oal_uint8 uc_pool_id,
oal_uint16 us_pool_total_cnt,
oal_uint16 us_pool_used_cnt,
oal_uint8 uc_subpool_id,
oal_uint16 us_subpool_total_cnt,
oal_uint16 us_subpool_free_cnt)
{
oam_stats_mempool_stru st_device_mempool_info;
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint16 us_skb_len; /* skb总长度 */
oal_uint32 ul_tick;
oal_uint32 ul_ret = OAL_SUCC;
oal_uint16 us_stru_len;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
/* 填写要上报给sdt的内存池信息结构体 */
st_device_mempool_info.uc_mem_pool_id = uc_pool_id;
st_device_mempool_info.uc_subpool_id = uc_subpool_id;
st_device_mempool_info.us_mem_pool_total_cnt = us_pool_total_cnt;
st_device_mempool_info.us_mem_pool_used_cnt = us_pool_used_cnt;
st_device_mempool_info.us_subpool_total_cnt = us_subpool_total_cnt;
st_device_mempool_info.us_subpool_free_cnt = us_subpool_free_cnt;
us_stru_len = OAL_SIZEOF(oam_stats_mempool_stru);
/* 为ota消息上报SDT申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_stru_len + OAL_SIZEOF(oam_ota_hdr_stru);
if (us_skb_len > WLAN_SDT_NETBUF_MAX_PAYLOAD)
{
us_skb_len = WLAN_SDT_NETBUF_MAX_PAYLOAD;
us_stru_len = us_skb_len - OAL_SIZEOF(oam_ota_hdr_stru);
}
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_MEMPOOL;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_stru_len;
/* 复制数据,填写ota数据 */
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)&st_device_mempool_info,
(oal_uint32)us_stru_len);
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
/*****************************************************************************
函 数 名 : sdt_drv_netlink_send
功能描述 : SDT驱动侧通过netlink向SDT APP发送数据
记录待发送的数据与发送失败的数据；通过序列号记录
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年1月27日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 sdt_drv_netlink_send(oal_netbuf_stru *pst_netbuf, oal_uint32 ul_len)
{
#if (_PRE_OS_VERSION_RAW != _PRE_OS_VERSION)
#if((_PRE_TARGET_PRODUCT_TYPE_5610DMB == _PRE_CONFIG_TARGET_PRODUCT)\
||(_PRE_TARGET_PRODUCT_TYPE_VSPM310DMB == _PRE_CONFIG_TARGET_PRODUCT)\
||(_PRE_TARGET_PRODUCT_TYPE_WS835DMB == _PRE_CONFIG_TARGET_PRODUCT))
oal_int32 l_ret_len = 0;
sdt_drv_pkt_hdr_stru *p_sdt_hdr;
#endif
oal_netbuf_stru *pst_copy_netbuf;
oal_nlmsghdr_stru *pst_nlhdr;
oal_uint32 ul_nlmsg_len;
oal_int32 l_unicast_bytes = 0;
/* 由上层保证参数非空 */
/* 如果没有与app建立连接，则直接返回，每500次打印一次提示信息 */
if (0 == g_st_sdt_drv_mng_entry.ul_usepid)
{
if (0 == (oal_atomic_read(&g_st_sdt_drv_mng_entry.ul_unconnect_cnt) % SDT_DRV_REPORT_NO_CONNECT_FREQUENCE))
{
OAL_IO_PRINT("Info:waitting app_sdt start...\r\n");
oal_atomic_inc(&g_st_sdt_drv_mng_entry.ul_unconnect_cnt);
}
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
//oal_netbuf_free(pst_netbuf);
return OAL_FAIL;
}
#if ((_PRE_TARGET_PRODUCT_TYPE_5610DMB == _PRE_CONFIG_TARGET_PRODUCT)\
||(_PRE_TARGET_PRODUCT_TYPE_VSPM310DMB == _PRE_CONFIG_TARGET_PRODUCT)\
||(_PRE_TARGET_PRODUCT_TYPE_WS835DMB == _PRE_CONFIG_TARGET_PRODUCT))
// 数据包分析
p_sdt_hdr = (sdt_drv_pkt_hdr_stru*)oal_netbuf_data(pst_netbuf);
if (OAM_DATA_TYPE_LOG == p_sdt_hdr->en_msg_type || OAM_DATA_TYPE_OTA == p_sdt_hdr->en_msg_type)
{
if (0 == g_st_count)
{
ul_nlmsg_len = OAL_NLMSG_LENGTH(MAX_NLMSG_LEN);
g_pst_copy_netbuf = oal_netbuf_alloc(ul_nlmsg_len, 0, WLAN_MEM_NETBUF_ALIGN);
if (OAL_UNLIKELY(OAL_PTR_NULL == g_pst_copy_netbuf))
{
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
//oal_netbuf_free(pst_netbuf);
OAL_IO_PRINT("oal_netbuf_alloc failed. \r\n");
return OAL_FAIL;
}
g_pst_nlhdr = oal_nlmsg_put(g_pst_copy_netbuf, 0, 0, 0, (oal_int32)MAX_NLMSG_LEN, 0);
}
if (NULL != g_pst_nlhdr)
{
l_ret_len = MAX_NLMSG_LEN - g_buf_offset - ul_len;
if (l_ret_len > 0)
{
oal_memcopy((oal_void *)OAL_NLMSG_DATA(g_pst_nlhdr) + g_buf_offset, (const oal_void *)oal_netbuf_data(pst_netbuf), ul_len);
g_st_count++;
g_buf_offset += ul_len;
}
}
if (MAX_QUEUE_COUNT == g_st_count || g_buf_offset > MAX_CO_SIZE || l_ret_len < 0)
{
g_st_count = 0;
g_buf_offset = 0;
l_unicast_bytes = oal_netlink_unicast(g_st_sdt_drv_mng_entry.pst_nlsk, g_pst_copy_netbuf, g_st_sdt_drv_mng_entry.ul_usepid, 0);
oal_msleep(300);
OAM_SDT_STAT_INCR(ul_nlk_sd_cnt);
if (l_unicast_bytes <= 0)
{
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
//oal_netbuf_free(pst_netbuf);
oal_msleep(500);
OAM_SDT_STAT_INCR(ul_nlk_sd_fail);
return OAL_FAIL;
}
}
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
return OAL_SUCC;
}
#endif
/* 填写netlink消息头 */
ul_nlmsg_len = OAL_NLMSG_SPACE(ul_len);
pst_copy_netbuf = oal_netbuf_alloc(ul_nlmsg_len, 0, WLAN_MEM_NETBUF_ALIGN);
if (OAL_UNLIKELY(OAL_PTR_NULL == pst_copy_netbuf))
{
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
//oal_netbuf_free(pst_netbuf);
OAL_IO_PRINT("oal_netbuf_alloc failed. \r\n");
return OAL_FAIL;
}
pst_nlhdr = oal_nlmsg_put(pst_copy_netbuf, 0, 0, 0, (oal_int32)ul_len, 0);
oal_memcopy((oal_void *)OAL_NLMSG_DATA(pst_nlhdr), (const oal_void *)oal_netbuf_data(pst_netbuf), ul_len);
l_unicast_bytes = oal_netlink_unicast(g_st_sdt_drv_mng_entry.pst_nlsk, pst_copy_netbuf, g_st_sdt_drv_mng_entry.ul_usepid, OAL_MSG_DONTWAIT);
oal_mem_sdt_netbuf_free(pst_netbuf, OAL_TRUE);
//oal_netbuf_free(pst_netbuf);
OAM_SDT_STAT_INCR(ul_nlk_sd_cnt);
if (l_unicast_bytes <= 0)
{
OAM_SDT_STAT_INCR(ul_nlk_sd_fail);
return OAL_FAIL;
}
#endif
return OAL_SUCC;
}
/*****************************************************************************
函 数 名 : oam_stats_report_memblock_info_to_sdt
功能描述 : 将标准内存块的信息上报SDT
输入参数 : puc_origin_data:内存块的起始地址
uc_user_cnt :该内存块引用计数
uc_pool_id :所属的内存池id
uc_subpool_id :所属的子池id
us_len :该内存块长度
ul_file_id :申请该内存块的文件id
ul_alloc_line_num :申请该内存块的行号
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年2月21日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_stats_report_memblock_info_to_sdt(
oal_uint8 *puc_origin_data,
oal_uint8 uc_user_cnt,
oal_uint8 uc_pool_id,
oal_uint8 uc_subpool_id,
oal_uint16 us_len,
oal_uint32 ul_file_id,
oal_uint32 ul_alloc_line_num)
{
oam_memblock_info_stru st_memblock_info;
oal_uint16 us_memblock_info_len;
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint16 us_skb_len; /* skb总长度 */
oal_uint32 ul_tick;
oal_uint32 ul_ret = OAL_SUCC;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
if (OAL_PTR_NULL == puc_origin_data)
{
OAL_IO_PRINT("oam_stats_report_memblock_info_to_sdt:puc_origin_data is null!\n");
return OAL_ERR_CODE_PTR_NULL;
}
us_memblock_info_len = OAL_SIZEOF(oam_memblock_info_stru);
/* 填写要上报给sdt的内存块信息结构体 */
st_memblock_info.uc_pool_id = uc_pool_id;
st_memblock_info.uc_subpool_id = uc_subpool_id;
st_memblock_info.uc_user_cnt = uc_user_cnt;
st_memblock_info.ul_alloc_line_num = ul_alloc_line_num;
st_memblock_info.ul_file_id = ul_file_id;
/* 为ota消息上报SDT申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_memblock_info_len + us_len + OAL_SIZEOF(oam_ota_hdr_stru);
if (us_skb_len > WLAN_SDT_NETBUF_MAX_PAYLOAD)
{
us_skb_len = WLAN_SDT_NETBUF_MAX_PAYLOAD;
if ((us_memblock_info_len + OAL_SIZEOF(oam_ota_hdr_stru)) < us_skb_len)
{
us_len = us_skb_len - us_memblock_info_len - (oal_uint16)OAL_SIZEOF(oam_ota_hdr_stru);
}
else
{
us_memblock_info_len = us_skb_len - OAL_SIZEOF(oam_ota_hdr_stru);
us_len = 0;
}
}
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = OAM_OTA_TYPE_MEMBLOCK;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = (oal_uint8)us_memblock_info_len;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_memblock_info_len + us_len;
/* 填写ota数据部分,首先复制内存块的信息结构体 */
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)&st_memblock_info,
(oal_uint32)us_memblock_info_len);
/* 复制内存块的具体内容 *//*lint -e416*/
oal_memcopy((oal_void *)(pst_ota_data->auc_ota_data + us_memblock_info_len),
(const oal_void *)puc_origin_data,
(oal_uint32)us_len);
/*lint +e416*/
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
/*****************************************************************************
函 数 名 : oam_stats_report_stat_info_to_sdt
功能描述 : 将所有维测统计信息上报SDT工具
输入参数 : 无
输出参数 : 无
返 回 值 :
调用函数 :
被调函数 :
修改历史 :
1.日 期 : 2014年3月18日
作 者 : z00237171
修改内容 : 新生成函数
*****************************************************************************/
oal_uint32 oam_stats_report_info_to_sdt(oam_ota_type_enum_uint8 en_ota_type)
{
oal_uint32 ul_tick;
oal_uint16 us_skb_len; /* skb总长度 */
oal_netbuf_stru *pst_netbuf;
oam_ota_stru *pst_ota_data;
oal_uint32 ul_ret = OAL_SUCC;
oal_uint16 us_stat_info_len;
if (OAL_UNLIKELY(OAL_PTR_NULL == g_st_oam_sdt_func_hook.p_sdt_report_data_func))
{
return OAL_ERR_CODE_PTR_NULL;
}
switch (en_ota_type)
{
case OAM_OTA_TYPE_DEV_STAT_INFO:
us_stat_info_len = OAL_SIZEOF(oam_device_stat_info_stru) * WLAN_DEVICE_MAX_NUM_PER_CHIP;
break;
case OAM_OTA_TYPE_VAP_STAT_INFO:
us_stat_info_len = (oal_uint16)(OAL_SIZEOF(oam_vap_stat_info_stru) * WLAN_VAP_SUPPORT_MAX_NUM_LIMIT);
break;
default:
us_stat_info_len = 0;
break;
}
if (0 == us_stat_info_len)
{
OAL_IO_PRINT("oam_stats_report_info_to_sdt::ota_type invalid-->%d!\n", en_ota_type);
return OAL_ERR_CODE_INVALID_CONFIG;
}
/* 为上报统计信息申请空间,头部预留8字节，尾部预留1字节，给sdt_drv用 */
us_skb_len = us_stat_info_len + OAL_SIZEOF(oam_ota_hdr_stru);
if (us_skb_len > WLAN_SDT_NETBUF_MAX_PAYLOAD)
{
us_skb_len = WLAN_SDT_NETBUF_MAX_PAYLOAD;
us_stat_info_len = WLAN_SDT_NETBUF_MAX_PAYLOAD - OAL_SIZEOF(oam_ota_hdr_stru);
}
pst_netbuf = oam_alloc_data2sdt(us_skb_len);
if (OAL_PTR_NULL == pst_netbuf)
{
return OAL_ERR_CODE_PTR_NULL;
}
pst_ota_data = (oam_ota_stru *)oal_netbuf_data(pst_netbuf);
/* 获取系统TICK值 */
ul_tick = (oal_uint32)OAL_TIME_GET_STAMP_MS();
/* 填写ota消息头结构体 */
pst_ota_data->st_ota_hdr.ul_tick = ul_tick;
pst_ota_data->st_ota_hdr.en_ota_type = en_ota_type;
pst_ota_data->st_ota_hdr.uc_frame_hdr_len = 0;
pst_ota_data->st_ota_hdr.us_ota_data_len = us_stat_info_len;
/* 复制数据,填写ota数据 */
switch (en_ota_type)
{
case OAM_OTA_TYPE_DEV_STAT_INFO:
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)g_st_stat_info.ast_dev_stat_info,
us_stat_info_len);
break;
case OAM_OTA_TYPE_VAP_STAT_INFO:
oal_memcopy((oal_void *)pst_ota_data->auc_ota_data,
(const oal_void *)g_st_stat_info.ast_vap_stat_info,
us_stat_info_len);
break;
default:
break;
}
/* 下发至sdt接收队列，若队列满则串口输出 */
ul_ret = oam_report_data2sdt(pst_netbuf, OAM_DATA_TYPE_OTA, OAM_PRIMID_TYPE_OUTPUT_CONTENT);
return ul_ret;
}
