void unifi_mgt_media_status_ind(void *drvpriv,
CsrUint16 appHandlesCount, void* *appHandles,
unifi_MediaStatus mediaStatus,
const unifi_ConnectionInfo* connection_info,
unifi_IEEE80211Reason disassocReason,
unifi_IEEE80211Reason deauthReason)
{
unifi_priv_t *priv = (unifi_priv_t*)drvpriv;
if (priv->smepriv == NULL) {
unifi_error(priv, "unifi_mgt_media_status_ind: invalid smepriv\n");
return;
}
if (mediaStatus == unifi_MediaConnected) {
/*
* Send wireless-extension event up to userland to announce
* connection.
*/
wext_send_assoc_event(priv,
(unsigned char *)connection_info->bssid.data,
(unsigned char *)connection_info->assocReqInfoElements,
connection_info->assocReqInfoElementsLength,
(unsigned char *)connection_info->assocRspInfoElements,
connection_info->assocRspInfoElementsLength,
(unsigned char *)connection_info->assocScanInfoElements,
connection_info->assocScanInfoElementsLength);
unifi_trace(priv, UDBG2,
"unifi_mgt_media_status_ind: IBSS=%02X:%02X:%02X:%02X:%02X:%02X\n",
connection_info->bssid.data[0],
connection_info->bssid.data[1],
connection_info->bssid.data[2],
connection_info->bssid.data[3],
connection_info->bssid.data[4],
connection_info->bssid.data[5]);
sme_mgt_packet_filter_set(priv);
} else {
/*
* Send wireless-extension event up to userland to announce
* connection lost to a BSS.
*/
wext_send_disassoc_event(priv);
}
}
int unifi_cfg_packet_filters(unifi_priv_t *priv, unsigned char *arg)
{
unsigned char *tclas_buffer;
unsigned int tclas_buffer_length;
tclas_t *dhcp_tclas;
int rc;
/* Free any TCLASs previously allocated */
if (priv->packet_filters.tclas_ies_length) {
kfree(priv->filter_tclas_ies);
priv->filter_tclas_ies = NULL;
}
tclas_buffer = ((unsigned char*)arg) + sizeof(unifi_cfg_command_t) + sizeof(unsigned int);
if (copy_from_user(&priv->packet_filters, (void*)tclas_buffer,
sizeof(uf_cfg_bcast_packet_filter_t))) {
unifi_error(priv, "UNIFI_CFG: Failed to get the filter struct\n");
return -EFAULT;
}
tclas_buffer_length = priv->packet_filters.tclas_ies_length;
/* Allocate TCLASs if necessary */
if (priv->packet_filters.dhcp_filter) {
priv->packet_filters.tclas_ies_length += sizeof(tclas_t);
}
if (priv->packet_filters.tclas_ies_length > 0) {
priv->filter_tclas_ies = kmalloc(priv->packet_filters.tclas_ies_length, GFP_KERNEL);
if (priv->filter_tclas_ies == NULL) {
return -ENOMEM;
}
if (tclas_buffer_length) {
tclas_buffer += sizeof(uf_cfg_bcast_packet_filter_t) - sizeof(unsigned char*);
if (copy_from_user(priv->filter_tclas_ies,
tclas_buffer,
tclas_buffer_length)) {
unifi_error(priv, "UNIFI_CFG: Failed to get the TCLAS buffer\n");
return -EFAULT;
}
}
}
if(priv->packet_filters.dhcp_filter)
{
/* Append the DHCP tclas IE */
dhcp_tclas = (tclas_t*)(priv->filter_tclas_ies + tclas_buffer_length);
memset(dhcp_tclas, 0, sizeof(tclas_t));
dhcp_tclas->element_id = 14;
dhcp_tclas->length = sizeof(tcpip_clsfr_t) + 1;
dhcp_tclas->user_priority = 0;
dhcp_tclas->tcp_ip_cls_fr.cls_fr_type = 1;
dhcp_tclas->tcp_ip_cls_fr.version = 4;
((u8*)(&dhcp_tclas->tcp_ip_cls_fr.source_port))[0] = 0x00;
((u8*)(&dhcp_tclas->tcp_ip_cls_fr.source_port))[1] = 0x44;
((u8*)(&dhcp_tclas->tcp_ip_cls_fr.dest_port))[0] = 0x00;
((u8*)(&dhcp_tclas->tcp_ip_cls_fr.dest_port))[1] = 0x43;
dhcp_tclas->tcp_ip_cls_fr.protocol = 0x11;
dhcp_tclas->tcp_ip_cls_fr.cls_fr_mask = 0x58; //bits: 3,4,6
}
rc = sme_mgt_packet_filter_set(priv);
return rc;
}
