MiPad4/android_device_xiaomi_sdm660-common
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions
android_device_xiaomi_sdm66.../data-ipa-cfg-mgr/ipacm/src/IPACM_LanToLan.cpp
Max Weffers 4d31d8482d
Revert "sdm660-common: Move to common data-ipa-cfg-mgr" 
This reverts commit 98c3540df1.

Revert needed due Wifi Offload service crashing device and cause soft reboot
2019-12-23 08:59:25 +01:00

2093 lines
71 KiB
C++
Raw Blame History

/*
Copyright (c) 2014-2019, The Linux Foundation. All rights reserved.
Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are
met:
* Redistributions of source code must retain the above copyright
notice, this list of conditions and the following disclaimer.
* Redistributions in binary form must reproduce the above
copyright notice, this list of conditions and the following
disclaimer in the documentation and/or other materials provided
with the distribution.
* Neither the name of The Linux Foundation nor the names of its
contributors may be used to endorse or promote products derived
from this software without specific prior written permission.
THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/*!
@file
IPACM_LanToLan.cpp
@brief
This file implements the functionality of offloading LAN to LAN traffic.
@Author
Shihuan Liu
*/
#include <stdlib.h>
#include "IPACM_LanToLan.h"
#include "IPACM_Wlan.h"
#define __stringify(x...) #x
const char *ipa_l2_hdr_type[] = {
__stringify(NONE),
__stringify(ETH_II),
__stringify(802_3),
__stringify(L2_MAX)
};
IPACM_LanToLan* IPACM_LanToLan::p_instance;
IPACM_LanToLan_Iface::IPACM_LanToLan_Iface(IPACM_Lan *p_iface)
{
int i;
m_p_iface = p_iface;
memset(m_is_ip_addr_assigned, 0, sizeof(m_is_ip_addr_assigned));
m_support_inter_iface_offload = true;
m_support_intra_iface_offload = false;
m_is_l2tp_iface = false;
for(i = 0; i < IPA_HDR_L2_MAX; i++)
{
ref_cnt_peer_l2_hdr_type[i] = 0;
hdr_proc_ctx_for_inter_interface[i] = 0;
}
hdr_proc_ctx_for_intra_interface = 0;
hdr_proc_ctx_for_l2tp = 0;
if(p_iface->ipa_if_cate == WLAN_IF)
{
IPACMDBG_H("Interface %s is WLAN interface.\n", p_iface->dev_name);
m_support_intra_iface_offload = true;
if( ((IPACM_Wlan*)p_iface)->is_guest_ap() )
{
IPACMDBG_H("Interface %s is guest AP.\n", p_iface->dev_name);
m_support_inter_iface_offload = false;
}
}
return;
}
IPACM_LanToLan_Iface::~IPACM_LanToLan_Iface()
{
}
IPACM_LanToLan::IPACM_LanToLan()
{
IPACM_EvtDispatcher::registr(IPA_ETH_BRIDGE_IFACE_UP, this);
IPACM_EvtDispatcher::registr(IPA_ETH_BRIDGE_IFACE_DOWN, this);
IPACM_EvtDispatcher::registr(IPA_ETH_BRIDGE_CLIENT_ADD, this);
IPACM_EvtDispatcher::registr(IPA_ETH_BRIDGE_CLIENT_DEL, this);
IPACM_EvtDispatcher::registr(IPA_ETH_BRIDGE_WLAN_SCC_MCC_SWITCH, this);
#ifdef FEATURE_L2TP
IPACM_EvtDispatcher::registr(IPA_ADD_VLAN_IFACE, this);
IPACM_EvtDispatcher::registr(IPA_DEL_VLAN_IFACE, this);
IPACM_EvtDispatcher::registr(IPA_ADD_L2TP_VLAN_MAPPING, this);
IPACM_EvtDispatcher::registr(IPA_DEL_L2TP_VLAN_MAPPING, this);
IPACM_EvtDispatcher::registr(IPA_HANDLE_VLAN_CLIENT_INFO, this);
IPACM_EvtDispatcher::registr(IPA_HANDLE_VLAN_IFACE_INFO, this);
#endif
m_has_l2tp_iface = false;
return;
}
IPACM_LanToLan::~IPACM_LanToLan()
{
IPACMDBG_DMESG("WARNING: UNEXPECTEDLY KILL LAN2LAN CONTROLLER!\n");
return;
}
IPACM_LanToLan* IPACM_LanToLan::get_instance()
{
if(p_instance == NULL)
{
p_instance = new IPACM_LanToLan();
IPACMDBG_H("Created LanToLan instance.\n");
}
return p_instance;
}
#ifdef FEATURE_L2TP
bool IPACM_LanToLan::has_l2tp_iface()
{
list<IPACM_LanToLan_Iface>::iterator it;
bool has_l2tp_iface = false;
for(it = m_iface.begin(); it != m_iface.end(); it++)
{
if(it->is_l2tp_iface() == true)
{
has_l2tp_iface = true;
break;
}
}
return has_l2tp_iface;
}
#endif
void IPACM_LanToLan::event_callback(ipa_cm_event_id event, void* param)
{
ipacm_event_eth_bridge *eth_bridge_data;
const char *eventName = IPACM_Iface::ipacmcfg->getEventName(event);
#ifdef FEATURE_L2TP
ipa_ioc_vlan_iface_info *vlan_iface_data;
ipa_ioc_l2tp_vlan_mapping_info *l2tp_vlan_mapping_data;
ipacm_event_data_all *vlan_data;
#endif
if (eventName != NULL)
IPACMDBG_H("Get %s event.\n", eventName);
switch(event)
{
case IPA_ETH_BRIDGE_IFACE_UP:
{
eth_bridge_data = (ipacm_event_eth_bridge*)param;
handle_iface_up(eth_bridge_data);
break;
}
case IPA_ETH_BRIDGE_IFACE_DOWN:
{
eth_bridge_data = (ipacm_event_eth_bridge*)param;
handle_iface_down(eth_bridge_data);
break;
}
case IPA_ETH_BRIDGE_CLIENT_ADD:
{
eth_bridge_data = (ipacm_event_eth_bridge*)param;
handle_client_add(eth_bridge_data);
break;
}
case IPA_ETH_BRIDGE_CLIENT_DEL:
{
eth_bridge_data = (ipacm_event_eth_bridge*)param;
handle_client_del(eth_bridge_data);
break;
}
case IPA_ETH_BRIDGE_WLAN_SCC_MCC_SWITCH:
{
eth_bridge_data = (ipacm_event_eth_bridge*)param;
handle_wlan_scc_mcc_switch(eth_bridge_data);
break;
}
#ifdef FEATURE_L2TP
case IPA_ADD_VLAN_IFACE:
{
vlan_iface_data = (ipa_ioc_vlan_iface_info*)param;
handle_add_vlan_iface(vlan_iface_data);
break;
}
case IPA_DEL_VLAN_IFACE:
{
vlan_iface_data = (ipa_ioc_vlan_iface_info*)param;
handle_del_vlan_iface(vlan_iface_data);
break;
}
case IPA_ADD_L2TP_VLAN_MAPPING:
{
l2tp_vlan_mapping_data = (ipa_ioc_l2tp_vlan_mapping_info*)param;
handle_add_l2tp_vlan_mapping(l2tp_vlan_mapping_data);
break;
}
case IPA_DEL_L2TP_VLAN_MAPPING:
{
l2tp_vlan_mapping_data = (ipa_ioc_l2tp_vlan_mapping_info*)param;
handle_del_l2tp_vlan_mapping(l2tp_vlan_mapping_data);
break;
}
case IPA_HANDLE_VLAN_CLIENT_INFO:
{
vlan_data = (ipacm_event_data_all*)param;
handle_vlan_client_info(vlan_data);
break;
}
case IPA_HANDLE_VLAN_IFACE_INFO:
{
vlan_data = (ipacm_event_data_all*)param;
handle_vlan_iface_info(vlan_data);
break;
}
#endif
default:
break;
}
print_data_structure_info();
return;
}
void IPACM_LanToLan::handle_iface_up(ipacm_event_eth_bridge *data)
{
list<IPACM_LanToLan_Iface>::iterator it;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
#ifdef FEATURE_L2TP
bool has_l2tp_iface = false;
#endif
IPACMDBG_H("Interface name: %s IP type: %d\n", data->p_iface->dev_name, data->iptype);
for(it = m_iface.begin(); it != m_iface.end(); it++)
{
if(it->get_iface_pointer() == data->p_iface)
{
IPACMDBG_H("Found the interface.\n");
if(it->get_m_is_ip_addr_assigned(data->iptype) == false)
{
IPACMDBG_H("IP type %d was not active before, activating it now.\n", data->iptype);
it->set_m_is_ip_addr_assigned(data->iptype, true);
/* install inter-interface rules */
if(it->get_m_support_inter_iface_offload())
it->add_all_inter_interface_client_flt_rule(data->iptype);
/* install intra-BSS rules */
if(it->get_m_support_intra_iface_offload())
it->add_all_intra_interface_client_flt_rule(data->iptype);
}
break;
}
}
if(it == m_iface.end()) //If the interface has not been created before
{
if(m_iface.size() == MAX_NUM_IFACE)
{
IPACMERR("The number of interfaces has reached maximum %d.\n", MAX_NUM_IFACE);
return;
}
if(!data->p_iface->tx_prop || !data->p_iface->rx_prop)
{
IPACMERR("The interface %s does not have tx_prop or rx_prop.\n", data->p_iface->dev_name);
return;
}
if(data->p_iface->tx_prop->tx[0].hdr_l2_type == IPA_HDR_L2_NONE || data->p_iface->tx_prop->tx[0].hdr_l2_type == IPA_HDR_L2_MAX)
{
IPACMERR("Invalid l2 header type %s!\n", ipa_l2_hdr_type[data->p_iface->tx_prop->tx[0].hdr_l2_type]);
return;
}
IPACMDBG_H("Does not find the interface, insert a new one.\n");
IPACM_LanToLan_Iface new_iface(data->p_iface);
new_iface.set_m_is_ip_addr_assigned(data->iptype, true);
m_iface.push_front(new_iface);
IPACMDBG_H("Now the total number of interfaces is %zu.\n", m_iface.size());
IPACM_LanToLan_Iface &front_iface = m_iface.front();
#ifdef FEATURE_L2TP
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(front_iface.set_l2tp_iface(it_mapping->vlan_iface_name) == true)
{
has_l2tp_iface = true;
}
}
if(m_has_l2tp_iface == false && has_l2tp_iface == true)
{
IPACMDBG_H("There is l2tp iface, add rt rules for l2tp iface.\n");
m_has_l2tp_iface = true;
for(it = ++m_iface.begin(); it != m_iface.end(); it++)
{
if(it->is_l2tp_iface() == false)
{
it->handle_l2tp_enable();
}
}
}
#endif
/* install inter-interface rules */
if(front_iface.get_m_support_inter_iface_offload())
{
for(it = ++m_iface.begin(); it != m_iface.end(); it++)
{
/* add peer info only when both interfaces support inter-interface communication */
if(it->get_m_support_inter_iface_offload())
{
/* populate hdr_proc_ctx and routing table handle */
handle_new_iface_up(&front_iface, &(*it));
/* add client specific routing rule on existing interface */
it->add_client_rt_rule_for_new_iface();
}
}
/* add client specific filtering rule on new interface */
front_iface.add_all_inter_interface_client_flt_rule(data->iptype);
}
/* populate the intra-interface information */
if(front_iface.get_m_support_intra_iface_offload())
{
front_iface.handle_intra_interface_info();
}
/* handle cached client add event */
handle_cached_client_add_event(front_iface.get_iface_pointer());
}
return;
}
void IPACM_LanToLan::handle_iface_down(ipacm_event_eth_bridge *data)
{
list<IPACM_LanToLan_Iface>::iterator it_target_iface;
#ifdef FEATURE_L2TP
bool has_l2tp_iface = false;
#endif
IPACMDBG_H("Interface name: %s\n", data->p_iface->dev_name);
for(it_target_iface = m_iface.begin(); it_target_iface != m_iface.end(); it_target_iface++)
{
if(it_target_iface->get_iface_pointer() == data->p_iface)
{
IPACMDBG_H("Found the interface.\n");
break;
}
}
if(it_target_iface == m_iface.end())
{
IPACMDBG_H("The interface has not been found.\n");
/* clear cached client add event for the unfound interface*/
clear_cached_client_add_event(data->p_iface);
return;
}
it_target_iface->handle_down_event();
m_iface.erase(it_target_iface);
#ifdef FEATURE_L2TP
for(it_target_iface = m_iface.begin(); it_target_iface != m_iface.end(); it_target_iface++)
{
if(it_target_iface->is_l2tp_iface() == true)
{
has_l2tp_iface = true;
break;
}
}
if(m_has_l2tp_iface == true && has_l2tp_iface == false)
{
IPACMDBG_H("There is no l2tp iface now, delete rt rules for l2tp iface.\n");
m_has_l2tp_iface = false;
for(it_target_iface = m_iface.begin(); it_target_iface != m_iface.end(); it_target_iface++)
{
if(it_target_iface->is_l2tp_iface() == false)
{
it_target_iface->handle_l2tp_disable();
}
}
}
#endif
return;
}
void IPACM_LanToLan::handle_new_iface_up(IPACM_LanToLan_Iface *new_iface, IPACM_LanToLan_Iface *exist_iface)
{
char rt_tbl_name_for_flt[IPA_IP_MAX][IPA_RESOURCE_NAME_MAX];
char rt_tbl_name_for_rt[IPA_IP_MAX][IPA_RESOURCE_NAME_MAX];
IPACMDBG_H("Populate peer info between: new_iface %s, existing iface %s\n", new_iface->get_iface_pointer()->dev_name,
exist_iface->get_iface_pointer()->dev_name);
/* populate the routing table information */
snprintf(rt_tbl_name_for_flt[IPA_IP_v4], IPA_RESOURCE_NAME_MAX, "eth_v4_%s_to_%s",
ipa_l2_hdr_type[exist_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type],
ipa_l2_hdr_type[new_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type]);
IPACMDBG_H("IPv4 routing table for flt name: %s\n", rt_tbl_name_for_flt[IPA_IP_v4]);
snprintf(rt_tbl_name_for_flt[IPA_IP_v6], IPA_RESOURCE_NAME_MAX, "eth_v6_%s_to_%s",
ipa_l2_hdr_type[exist_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type],
ipa_l2_hdr_type[new_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type]);
IPACMDBG_H("IPv6 routing table for flt name: %s\n", rt_tbl_name_for_flt[IPA_IP_v6]);
snprintf(rt_tbl_name_for_rt[IPA_IP_v4], IPA_RESOURCE_NAME_MAX, "eth_v4_%s_to_%s",
ipa_l2_hdr_type[new_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type],
ipa_l2_hdr_type[exist_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type]);
IPACMDBG_H("IPv4 routing table for rt name: %s\n", rt_tbl_name_for_rt[IPA_IP_v4]);
snprintf(rt_tbl_name_for_rt[IPA_IP_v6], IPA_RESOURCE_NAME_MAX, "eth_v6_%s_to_%s",
ipa_l2_hdr_type[new_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type],
ipa_l2_hdr_type[exist_iface->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type]);
IPACMDBG_H("IPv6 routing table for rt name: %s\n", rt_tbl_name_for_rt[IPA_IP_v6]);
/* add new peer info in both new iface and existing iface */
exist_iface->handle_new_iface_up(rt_tbl_name_for_flt, rt_tbl_name_for_rt, new_iface);
new_iface->handle_new_iface_up(rt_tbl_name_for_rt, rt_tbl_name_for_flt, exist_iface);
return;
}
void IPACM_LanToLan::handle_client_add(ipacm_event_eth_bridge *data)
{
list<IPACM_LanToLan_Iface>::iterator it_iface;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
l2tp_vlan_mapping_info *mapping_info = NULL;
bool is_l2tp_client = false;
IPACMDBG_H("Incoming client MAC: 0x%02x%02x%02x%02x%02x%02x, interface: %s\n", data->mac_addr[0], data->mac_addr[1],
data->mac_addr[2], data->mac_addr[3], data->mac_addr[4], data->mac_addr[5], data->p_iface->dev_name);
#ifdef FEATURE_L2TP
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(strncmp(it_mapping->l2tp_iface_name, data->iface_name,
sizeof(it_mapping->l2tp_iface_name)) == 0)
{
IPACMDBG_H("Found l2tp iface %s with l2tp client MAC 0x%02x%02x%02x%02x%02x%02x\n",
it_mapping->l2tp_iface_name, it_mapping->l2tp_client_mac[0], it_mapping->l2tp_client_mac[1],
it_mapping->l2tp_client_mac[2], it_mapping->l2tp_client_mac[3], it_mapping->l2tp_client_mac[4],
it_mapping->l2tp_client_mac[5]);
memcpy(it_mapping->l2tp_client_mac, data->mac_addr, sizeof(it_mapping->l2tp_client_mac));
mapping_info = &(*it_mapping);
is_l2tp_client = true;
break;
}
}
#endif
for(it_iface = m_iface.begin(); it_iface != m_iface.end(); it_iface++)
{
if(it_iface->get_iface_pointer() == data->p_iface) //find the interface
{
IPACMDBG_H("Found the interface.\n");
it_iface->handle_client_add(data->mac_addr, is_l2tp_client, mapping_info, data->ep);
break;
}
}
/* if the iface was not found, cache the client add event */
if(it_iface == m_iface.end())
{
IPACMDBG_H("The interface is not found.\n");
if(m_cached_client_add_event.size() < MAX_NUM_CACHED_CLIENT_ADD_EVENT)
{
IPACMDBG_H("Cached the client information.\n");
m_cached_client_add_event.push_front(*data);
}
else
{
IPACMDBG_H("Cached client add event has reached maximum number.\n");
}
}
return;
}
void IPACM_LanToLan::handle_client_del(ipacm_event_eth_bridge *data)
{
list<IPACM_LanToLan_Iface>::iterator it_iface;
IPACMDBG_H("Incoming client MAC: 0x%02x%02x%02x%02x%02x%02x, interface: %s\n", data->mac_addr[0], data->mac_addr[1],
data->mac_addr[2], data->mac_addr[3], data->mac_addr[4], data->mac_addr[5], data->p_iface->dev_name);
for(it_iface = m_iface.begin(); it_iface != m_iface.end(); it_iface++)
{
if(it_iface->get_iface_pointer() == data->p_iface) //found the interface
{
IPACMDBG_H("Found the interface.\n");
it_iface->handle_client_del(data->mac_addr);
break;
}
}
if(it_iface == m_iface.end())
{
IPACMDBG_H("The interface is not found.\n");
}
return;
}
void IPACM_LanToLan::handle_wlan_scc_mcc_switch(ipacm_event_eth_bridge *data)
{
list<IPACM_LanToLan_Iface>::iterator it_iface;
IPACMDBG_H("Incoming interface: %s\n", data->p_iface->dev_name);
for(it_iface = m_iface.begin(); it_iface != m_iface.end(); it_iface++)
{
if(it_iface->get_iface_pointer() == data->p_iface)
{
it_iface->handle_wlan_scc_mcc_switch();
break;
}
}
return;
}
#ifdef FEATURE_L2TP
void IPACM_LanToLan::handle_add_vlan_iface(ipa_ioc_vlan_iface_info *data)
{
list<vlan_iface_info>::iterator it_vlan;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
vlan_iface_info new_vlan_info;
IPACMDBG_H("Vlan iface: %s vlan id: %d\n", data->name, data->vlan_id);
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
if(strncmp(it_vlan->vlan_iface_name, data->name, sizeof(it_vlan->vlan_iface_name)) == 0)
{
IPACMERR("The vlan iface was added before with id %d\n", it_vlan->vlan_id);
return;
}
}
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(strncmp(data->name, it_mapping->vlan_iface_name, sizeof(data->name)) == 0)
{
IPACMDBG_H("Found a mapping: l2tp iface %s.\n", it_mapping->l2tp_iface_name);
it_mapping->vlan_id = data->vlan_id;
}
}
memset(&new_vlan_info, 0 , sizeof(new_vlan_info));
strlcpy(new_vlan_info.vlan_iface_name, data->name, sizeof(new_vlan_info.vlan_iface_name));
new_vlan_info.vlan_id = data->vlan_id;
m_vlan_iface.push_front(new_vlan_info);
return;
}
void IPACM_LanToLan::handle_del_vlan_iface(ipa_ioc_vlan_iface_info *data)
{
list<vlan_iface_info>::iterator it_vlan;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
IPACMDBG_H("Vlan iface: %s vlan id: %d\n", data->name, data->vlan_id);
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
if(strncmp(it_vlan->vlan_iface_name, data->name, sizeof(it_vlan->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found the vlan interface\n");
m_vlan_iface.erase(it_vlan);
break;
}
}
it_mapping = m_l2tp_vlan_mapping.begin();
while(it_mapping != m_l2tp_vlan_mapping.end())
{
if(strncmp(data->name, it_mapping->vlan_iface_name, sizeof(data->name)) == 0)
{
IPACMDBG_H("Delete mapping with l2tp iface %s\n", it_mapping->l2tp_iface_name);
it_mapping = m_l2tp_vlan_mapping.erase(it_mapping);
}
else
{
it_mapping++;
}
}
return;
}
void IPACM_LanToLan::handle_add_l2tp_vlan_mapping(ipa_ioc_l2tp_vlan_mapping_info *data)
{
list<l2tp_vlan_mapping_info>::iterator it_mapping;
list<vlan_iface_info>::iterator it_vlan;
list<IPACM_LanToLan_Iface>::iterator it_iface;
IPACM_LanToLan_Iface *l2tp_iface;
l2tp_vlan_mapping_info new_mapping;
bool has_l2tp_iface = false;
IPACMDBG_H("L2tp iface: %s session id: %d vlan iface: %s \n",
data->l2tp_iface_name, data->l2tp_session_id, data->vlan_iface_name);
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(strncmp(data->l2tp_iface_name, it_mapping->l2tp_iface_name,
sizeof(data->l2tp_iface_name)) == 0)
{
IPACMERR("L2tp mapping was added before mapped to vlan %s.\n", it_mapping->vlan_iface_name);
return;
}
}
memset(&new_mapping, 0, sizeof(new_mapping));
strlcpy(new_mapping.l2tp_iface_name, data->l2tp_iface_name,
sizeof(new_mapping.l2tp_iface_name));
strlcpy(new_mapping.vlan_iface_name, data->vlan_iface_name,
sizeof(new_mapping.vlan_iface_name));
new_mapping.l2tp_session_id = data->l2tp_session_id;
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
if(strncmp(it_vlan->vlan_iface_name, data->vlan_iface_name, sizeof(it_vlan->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found vlan iface with id %d\n", it_vlan->vlan_id);
new_mapping.vlan_id = it_vlan->vlan_id;
memcpy(new_mapping.vlan_iface_ipv6_addr, it_vlan->vlan_iface_ipv6_addr,
sizeof(new_mapping.vlan_iface_ipv6_addr));
memcpy(new_mapping.vlan_client_mac, it_vlan->vlan_client_mac,
sizeof(new_mapping.vlan_client_mac));
memcpy(new_mapping.vlan_client_ipv6_addr, it_vlan->vlan_client_ipv6_addr,
sizeof(new_mapping.vlan_client_ipv6_addr));
break;
}
}
m_l2tp_vlan_mapping.push_front(new_mapping);
for(it_iface = m_iface.begin(); it_iface != m_iface.end(); it_iface++)
{
if(it_iface->set_l2tp_iface(data->vlan_iface_name) == true)
{
has_l2tp_iface = true;
l2tp_iface = &(*it_iface);
break;
}
}
if(m_has_l2tp_iface == false && has_l2tp_iface == true)
{
IPACMDBG_H("There is l2tp iface, add rt rules for l2tp iface.\n");
m_has_l2tp_iface = true;
for(it_iface = m_iface.begin(); it_iface != m_iface.end(); it_iface++)
{
if(it_iface->is_l2tp_iface() == false)
{
it_iface->handle_l2tp_enable();
}
}
l2tp_iface->switch_to_l2tp_iface();
}
return;
}
void IPACM_LanToLan::handle_del_l2tp_vlan_mapping(ipa_ioc_l2tp_vlan_mapping_info *data)
{
list<l2tp_vlan_mapping_info>::iterator it;
list<IPACM_LanToLan_Iface>::iterator it_iface;
IPACMDBG_H("L2tp iface: %s session id: %d vlan iface: %s \n",
data->l2tp_iface_name, data->l2tp_session_id, data->vlan_iface_name);
for(it = m_l2tp_vlan_mapping.begin(); it != m_l2tp_vlan_mapping.end(); it++)
{
if(strncmp(data->l2tp_iface_name, it->l2tp_iface_name,
sizeof(data->l2tp_iface_name)) == 0)
{
IPACMDBG_H("Found l2tp iface mapped to vlan %s.\n", it->vlan_iface_name);
if(strncmp(data->vlan_iface_name, it->vlan_iface_name,
sizeof(data->vlan_iface_name)) == 0)
{
m_l2tp_vlan_mapping.erase(it);
}
else
{
IPACMERR("Incoming mapping is incorrect.\n");
}
break;
}
}
return;
}
void IPACM_LanToLan::handle_vlan_client_info(ipacm_event_data_all *data)
{
list<l2tp_vlan_mapping_info>::iterator it_mapping;
list<vlan_iface_info>::iterator it_vlan;
IPACMDBG_H("Incoming vlan client iface: %s IPv6 address: 0x%08x%08x%08x%08x\n", data->iface_name,
data->ipv6_addr[0], data->ipv6_addr[1], data->ipv6_addr[2], data->ipv6_addr[3]);
IPACMDBG_H("MAC address: 0x%02x%02x%02x%02x%02x%02x\n", data->mac_addr[0], data->mac_addr[1],
data->mac_addr[2], data->mac_addr[3], data->mac_addr[4], data->mac_addr[5]);
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
if(strncmp(it_vlan->vlan_iface_name, data->iface_name, sizeof(it_vlan->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found vlan iface in vlan list: %s\n", it_vlan->vlan_iface_name);
if(it_vlan->vlan_client_ipv6_addr[0] > 0 || it_vlan->vlan_client_ipv6_addr[1] > 0 ||
it_vlan->vlan_client_ipv6_addr[2] > 0 || it_vlan->vlan_client_ipv6_addr[3] > 0)
{
IPACMDBG_H("Vlan client info has been populated before, return.\n");
return;
}
memcpy(it_vlan->vlan_client_mac, data->mac_addr, sizeof(it_vlan->vlan_client_mac));
memcpy(it_vlan->vlan_client_ipv6_addr, data->ipv6_addr, sizeof(it_vlan->vlan_client_ipv6_addr));
}
}
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(strncmp(it_mapping->vlan_iface_name, data->iface_name, sizeof(it_mapping->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found vlan iface in l2tp mapping list: %s, l2tp iface: %s\n", it_mapping->vlan_iface_name,
it_mapping->l2tp_iface_name);
memcpy(it_mapping->vlan_client_mac, data->mac_addr, sizeof(it_mapping->vlan_client_mac));
memcpy(it_mapping->vlan_client_ipv6_addr, data->ipv6_addr, sizeof(it_mapping->vlan_client_ipv6_addr));
}
}
return;
}
void IPACM_LanToLan::handle_vlan_iface_info(ipacm_event_data_all *data)
{
list<vlan_iface_info>::iterator it_vlan;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
IPACMDBG_H("Incoming vlan iface: %s IPv6 address: 0x%08x%08x%08x%08x\n", data->iface_name,
data->ipv6_addr[0], data->ipv6_addr[1], data->ipv6_addr[2], data->ipv6_addr[3]);
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
if(strncmp(it_vlan->vlan_iface_name, data->iface_name,
sizeof(it_vlan->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found vlan iface: %s\n", it_vlan->vlan_iface_name);
memcpy(it_vlan->vlan_iface_ipv6_addr, data->ipv6_addr,
sizeof(it_vlan->vlan_iface_ipv6_addr));
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
if(strncmp(it_mapping->vlan_iface_name, it_vlan->vlan_iface_name,
sizeof(it_mapping->vlan_iface_name)) == 0)
{
IPACMDBG_H("Found the l2tp-vlan mapping: l2tp %s\n", it_mapping->l2tp_iface_name);
memcpy(it_mapping->vlan_iface_ipv6_addr, data->ipv6_addr,
sizeof(it_mapping->vlan_iface_ipv6_addr));
}
}
break;
}
}
if(it_vlan == m_vlan_iface.end())
{
IPACMDBG_H("Failed to find the vlan iface: %s\n", data->iface_name);
}
return;
}
#endif
void IPACM_LanToLan::handle_cached_client_add_event(IPACM_Lan *p_iface)
{
list<ipacm_event_eth_bridge>::iterator it;
it = m_cached_client_add_event.begin();
while(it != m_cached_client_add_event.end())
{
if(it->p_iface == p_iface)
{
IPACMDBG_H("Found client with MAC: 0x%02x%02x%02x%02x%02x%02x\n", it->mac_addr[0], it->mac_addr[1],
it->mac_addr[2], it->mac_addr[3], it->mac_addr[4], it->mac_addr[5]);
handle_client_add(&(*it));
it = m_cached_client_add_event.erase(it);
}
else
{
it++;
}
}
return;
}
void IPACM_LanToLan::clear_cached_client_add_event(IPACM_Lan *p_iface)
{
list<ipacm_event_eth_bridge>::iterator it;
it = m_cached_client_add_event.begin();
while(it != m_cached_client_add_event.end())
{
if(it->p_iface == p_iface)
{
IPACMDBG_H("Found client with MAC: 0x%02x%02x%02x%02x%02x%02x\n", it->mac_addr[0], it->mac_addr[1],
it->mac_addr[2], it->mac_addr[3], it->mac_addr[4], it->mac_addr[5]);
it = m_cached_client_add_event.erase(it);
}
else
{
it++;
}
}
return;
}
void IPACM_LanToLan::print_data_structure_info()
{
list<IPACM_LanToLan_Iface>::iterator it;
list<ipacm_event_eth_bridge>::iterator it_event;
list<vlan_iface_info>::iterator it_vlan;
list<l2tp_vlan_mapping_info>::iterator it_mapping;
int i;
IPACMDBG_H("Is there l2tp interface? %d\n", m_has_l2tp_iface);
#ifdef FEATURE_L2TP
IPACMDBG_H("There are %zu vlan interfaces.\n", m_vlan_iface.size());
for(it_vlan = m_vlan_iface.begin(); it_vlan != m_vlan_iface.end(); it_vlan++)
{
IPACMDBG_H("Vlan iface: %s, id: %d, ipv6 addr: 0x%08x%08x%08x%08x\n", it_vlan->vlan_iface_name,
it_vlan->vlan_id, it_vlan->vlan_iface_ipv6_addr[0], it_vlan->vlan_iface_ipv6_addr[1],
it_vlan->vlan_iface_ipv6_addr[2], it_vlan->vlan_iface_ipv6_addr[3]);
IPACMDBG_H("Vlan client mac: 0x%02x%02x%02x%02x%02x%02x, ipv6 addr: 0x%08x%08x%08x%08x\n",
it_vlan->vlan_client_mac[0], it_vlan->vlan_client_mac[1], it_vlan->vlan_client_mac[2],
it_vlan->vlan_client_mac[3], it_vlan->vlan_client_mac[4], it_vlan->vlan_client_mac[5],
it_vlan->vlan_client_ipv6_addr[0], it_vlan->vlan_client_ipv6_addr[1], it_vlan->vlan_client_ipv6_addr[2],
it_vlan->vlan_client_ipv6_addr[3]);
}
IPACMDBG_H("There are %zu vlan-l2tp mapping.\n", m_l2tp_vlan_mapping.size());
for(it_mapping = m_l2tp_vlan_mapping.begin(); it_mapping != m_l2tp_vlan_mapping.end(); it_mapping++)
{
IPACMDBG_H("L2tp iface: %s, session id: %d\n", it_mapping->l2tp_iface_name, it_mapping->l2tp_session_id);
IPACMDBG_H("Vlan iface: %s, id: %d, ipv6 addr: 0x%08x%08x%08x%08x\n", it_mapping->vlan_iface_name,
it_mapping->vlan_id, it_mapping->vlan_iface_ipv6_addr[0], it_mapping->vlan_iface_ipv6_addr[1],
it_mapping->vlan_iface_ipv6_addr[2], it_mapping->vlan_iface_ipv6_addr[3]);
IPACMDBG_H("Vlan client mac: 0x%02x%02x%02x%02x%02x%02x, ipv6 addr: 0x%08x%08x%08x%08x\n",
it_mapping->vlan_client_mac[0], it_mapping->vlan_client_mac[1], it_mapping->vlan_client_mac[2],
it_mapping->vlan_client_mac[3], it_mapping->vlan_client_mac[4], it_mapping->vlan_client_mac[5],
it_mapping->vlan_client_ipv6_addr[0], it_mapping->vlan_client_ipv6_addr[1], it_mapping->vlan_client_ipv6_addr[2],
it_mapping->vlan_client_ipv6_addr[3]);
IPACMDBG_H("L2tp client mac: 0x%02x%02x%02x%02x%02x%02x\n", it_mapping->l2tp_client_mac[0], it_mapping->l2tp_client_mac[1],
it_mapping->l2tp_client_mac[2], it_mapping->l2tp_client_mac[3], it_mapping->l2tp_client_mac[4], it_mapping->l2tp_client_mac[5]);
}
#endif
IPACMDBG_H("There are %zu interfaces in total.\n", m_iface.size());
for(it = m_iface.begin(); it != m_iface.end(); it++)
{
it->print_data_structure_info();
}
IPACMDBG_H("There are %zu cached client add events in total.\n", m_cached_client_add_event.size());
i = 1;
for(it_event = m_cached_client_add_event.begin(); it_event != m_cached_client_add_event.end(); it_event++)
{
IPACMDBG_H("Client %d MAC: 0x%02x%02x%02x%02x%02x%02x, interface: %s\n", i, it_event->mac_addr[0], it_event->mac_addr[1], it_event->mac_addr[2],
it_event->mac_addr[3], it_event->mac_addr[4], it_event->mac_addr[5], it_event->p_iface->dev_name);
i++;
}
return;
}
void IPACM_LanToLan_Iface::add_client_rt_rule_for_new_iface()
{
list<client_info>::iterator it;
ipa_hdr_l2_type peer_l2_type;
peer_iface_info &peer = m_peer_iface_info.front();
peer_l2_type = peer.peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
if(ref_cnt_peer_l2_hdr_type[peer_l2_type] == 1)
{
for(it = m_client_info.begin(); it != m_client_info.end(); it++)
{
#ifdef FEATURE_L2TP
if(it->is_l2tp_client == false)
{
add_client_rt_rule(&peer, &(*it));
}
/* add l2tp rt rules */
add_l2tp_client_rt_rule(&peer, &(*it));
#else
add_client_rt_rule(&peer, &(*it));
#endif
}
}
return;
}
void IPACM_LanToLan_Iface::add_client_rt_rule(peer_iface_info *peer_info, client_info *client)
{
int i, num_rt_rule;
uint32_t rt_rule_hdl[MAX_NUM_PROP];
ipa_hdr_l2_type peer_l2_hdr_type;
peer_l2_hdr_type = peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
/* if the peer info is not for intra interface communication */
if(peer_info->peer != this)
{
IPACMDBG_H("This is for inter interface communication.\n");
m_p_iface->eth_bridge_add_rt_rule(client->mac_addr, peer_info->rt_tbl_name_for_rt[IPA_IP_v4], hdr_proc_ctx_for_inter_interface[peer_l2_hdr_type],
peer_l2_hdr_type, IPA_IP_v4, rt_rule_hdl, &num_rt_rule, client->ep);
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v4] = num_rt_rule;
IPACMDBG_H("Number of IPv4 routing rule is %d.\n", num_rt_rule);
for(i=0; i<num_rt_rule; i++)
{
IPACMDBG_H("Routing rule %d handle %d\n", i, rt_rule_hdl[i]);
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v4][i] = rt_rule_hdl[i];
}
m_p_iface->eth_bridge_add_rt_rule(client->mac_addr, peer_info->rt_tbl_name_for_rt[IPA_IP_v6], hdr_proc_ctx_for_inter_interface[peer_l2_hdr_type],
peer_l2_hdr_type, IPA_IP_v6, rt_rule_hdl, &num_rt_rule, client->ep);
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v6] = num_rt_rule;
IPACMDBG_H("Number of IPv6 routing rule is %d.\n", num_rt_rule);
for(i=0; i<num_rt_rule; i++)
{
IPACMDBG_H("Routing rule %d handle %d\n", i, rt_rule_hdl[i]);
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v6][i] = rt_rule_hdl[i];
}
}
else
{
IPACMDBG_H("This is for intra interface communication.\n");
m_p_iface->eth_bridge_add_rt_rule(client->mac_addr, peer_info->rt_tbl_name_for_rt[IPA_IP_v4], hdr_proc_ctx_for_intra_interface,
peer_l2_hdr_type, IPA_IP_v4, rt_rule_hdl, &num_rt_rule, client->ep);
client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4] = num_rt_rule;
IPACMDBG_H("Number of IPv4 routing rule is %d.\n", num_rt_rule);
for(i=0; i<num_rt_rule; i++)
{
IPACMDBG_H("Routing rule %d handle %d\n", i, rt_rule_hdl[i]);
client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4][i] = rt_rule_hdl[i];
}
m_p_iface->eth_bridge_add_rt_rule(client->mac_addr, peer_info->rt_tbl_name_for_rt[IPA_IP_v6], hdr_proc_ctx_for_intra_interface,
peer_l2_hdr_type, IPA_IP_v6, rt_rule_hdl, &num_rt_rule, client->ep);
client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6] = num_rt_rule;
IPACMDBG_H("Number of IPv6 routing rule is %d.\n", num_rt_rule);
for(i=0; i<num_rt_rule; i++)
{
IPACMDBG_H("Routing rule %d handle %d\n", i, rt_rule_hdl[i]);
client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6][i] = rt_rule_hdl[i];
}
}
return;
}
#ifdef FEATURE_L2TP
void IPACM_LanToLan_Iface::add_l2tp_client_rt_rule(peer_iface_info *peer, client_info *client)
{
ipa_hdr_l2_type peer_l2_hdr_type;
l2tp_vlan_mapping_info *mapping_info;
peer_l2_hdr_type = peer->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
mapping_info = client->mapping_info;
if(client->is_l2tp_client)
{
m_p_iface->add_l2tp_rt_rule(IPA_IP_v4, client->mac_addr, peer_l2_hdr_type, mapping_info->l2tp_session_id,
mapping_info->vlan_id, mapping_info->vlan_client_mac, mapping_info->vlan_iface_ipv6_addr,
mapping_info->vlan_client_ipv6_addr, &client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_hdl,
&client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_proc_ctx_hdl[IPA_IP_v4], &client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_hdr_hdl,
&client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v4], client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v4],
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_rt_rule_hdl);
m_p_iface->add_l2tp_rt_rule(IPA_IP_v6, client->mac_addr, peer_l2_hdr_type, mapping_info->l2tp_session_id,
mapping_info->vlan_id, mapping_info->vlan_client_mac, mapping_info->vlan_iface_ipv6_addr,
mapping_info->vlan_client_ipv6_addr, &client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_hdl,
&client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_proc_ctx_hdl[IPA_IP_v6], &client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_hdr_hdl,
&client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v6], client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v6],
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_rt_rule_hdl);
}
else
{
if(IPACM_LanToLan::get_instance()->has_l2tp_iface() == true)
{
m_p_iface->add_l2tp_rt_rule(IPA_IP_v6, client->mac_addr, &hdr_proc_ctx_for_l2tp, &client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v6],
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v6]);
}
}
return;
}
#endif
void IPACM_LanToLan_Iface::add_all_inter_interface_client_flt_rule(ipa_ip_type iptype)
{
list<peer_iface_info>::iterator it_iface;
list<client_info>::iterator it_client;
for(it_iface = m_peer_iface_info.begin(); it_iface != m_peer_iface_info.end(); it_iface++)
{
IPACMDBG_H("Add flt rules for clients of interface %s.\n", it_iface->peer->get_iface_pointer()->dev_name);
for(it_client = it_iface->peer->m_client_info.begin(); it_client != it_iface->peer->m_client_info.end(); it_client++)
{
add_client_flt_rule(&(*it_iface), &(*it_client), iptype);
}
}
return;
}
void IPACM_LanToLan_Iface::add_all_intra_interface_client_flt_rule(ipa_ip_type iptype)
{
list<client_info>::iterator it_client;
IPACMDBG_H("Add flt rules for own clients.\n");
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
add_client_flt_rule(&m_intra_interface_info, &(*it_client), iptype);
}
return;
}
void IPACM_LanToLan_Iface::add_one_client_flt_rule(IPACM_LanToLan_Iface *peer_iface, client_info *client)
{
list<peer_iface_info>::iterator it;
for(it = m_peer_iface_info.begin(); it != m_peer_iface_info.end(); it++)
{
if(it->peer == peer_iface)
{
IPACMDBG_H("Found the peer iface info.\n");
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
add_client_flt_rule(&(*it), client, IPA_IP_v4);
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
add_client_flt_rule(&(*it), client, IPA_IP_v6);
}
break;
}
}
return;
}
void IPACM_LanToLan_Iface::add_client_flt_rule(peer_iface_info *peer, client_info *client, ipa_ip_type iptype)
{
list<flt_rule_info>::iterator it_flt;
uint32_t flt_rule_hdl;
uint32_t l2tp_first_pass_flt_rule_hdl = 0, l2tp_second_pass_flt_rule_hdl = 0;
flt_rule_info new_flt_info;
ipa_ioc_get_rt_tbl rt_tbl;
if(m_is_l2tp_iface && iptype == IPA_IP_v4)
{
IPACMDBG_H("No need to install IPv4 flt rule on l2tp interface.\n");
return;
}
for(it_flt = peer->flt_rule.begin(); it_flt != peer->flt_rule.end(); it_flt++)
{
if(it_flt->p_client == client) //the client is already in the flt info list
{
IPACMDBG_H("The client is found in flt info list.\n");
break;
}
}
if(it_flt != peer->flt_rule.end())
{
l2tp_first_pass_flt_rule_hdl = it_flt->l2tp_first_pass_flt_rule_hdl[iptype];
l2tp_second_pass_flt_rule_hdl = it_flt->l2tp_second_pass_flt_rule_hdl;
}
#ifdef FEATURE_L2TP
if(m_is_l2tp_iface)
{
m_p_iface->add_l2tp_flt_rule(client->mac_addr, &l2tp_first_pass_flt_rule_hdl);
}
else
#endif
{
#ifdef FEATURE_L2TP
if(client->is_l2tp_client)
{
m_p_iface->add_l2tp_flt_rule(iptype, client->mac_addr, client->mapping_info->vlan_client_ipv6_addr,
&l2tp_first_pass_flt_rule_hdl, &l2tp_second_pass_flt_rule_hdl);
}
else
#endif
{
rt_tbl.ip = iptype;
memcpy(rt_tbl.name, peer->rt_tbl_name_for_flt[iptype], sizeof(rt_tbl.name));
IPACMDBG_H("This flt rule points to rt tbl %s.\n", rt_tbl.name);
if(IPACM_Iface::m_routing.GetRoutingTable(&rt_tbl) == false)
{
IPACMERR("Failed to get routing table.\n");
return;
}
m_p_iface->eth_bridge_add_flt_rule(client->mac_addr, rt_tbl.hdl,
iptype, &flt_rule_hdl);
IPACMDBG_H("Installed flt rule for IP type %d: handle %d\n", iptype, flt_rule_hdl);
}
}
if(it_flt != peer->flt_rule.end())
{
it_flt->flt_rule_hdl[iptype] = flt_rule_hdl;
it_flt->l2tp_first_pass_flt_rule_hdl[iptype] = l2tp_first_pass_flt_rule_hdl;
it_flt->l2tp_second_pass_flt_rule_hdl = l2tp_second_pass_flt_rule_hdl;
}
else
{
IPACMDBG_H("The client is not found in flt info list, insert a new one.\n");
memset(&new_flt_info, 0, sizeof(new_flt_info));
new_flt_info.p_client = client;
new_flt_info.flt_rule_hdl[iptype] = flt_rule_hdl;
new_flt_info.l2tp_first_pass_flt_rule_hdl[iptype] = l2tp_first_pass_flt_rule_hdl;
new_flt_info.l2tp_second_pass_flt_rule_hdl = l2tp_second_pass_flt_rule_hdl;
peer->flt_rule.push_front(new_flt_info);
}
return;
}
void IPACM_LanToLan_Iface::del_one_client_flt_rule(IPACM_LanToLan_Iface *peer_iface, client_info *client)
{
list<peer_iface_info>::iterator it;
for(it = m_peer_iface_info.begin(); it != m_peer_iface_info.end(); it++)
{
if(it->peer == peer_iface)
{
IPACMDBG_H("Found the peer iface info.\n");
del_client_flt_rule(&(*it), client);
break;
}
}
return;
}
void IPACM_LanToLan_Iface::del_client_flt_rule(peer_iface_info *peer, client_info *client)
{
list<flt_rule_info>::iterator it_flt;
for(it_flt = peer->flt_rule.begin(); it_flt != peer->flt_rule.end(); it_flt++)
{
if(it_flt->p_client == client) //found the client in flt info list
{
IPACMDBG_H("Found the client in flt info list.\n");
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
if(m_is_l2tp_iface)
{
IPACMDBG_H("No IPv4 client flt rule on l2tp iface.\n");
}
else
{
#ifdef FEATURE_L2TP
if(client->is_l2tp_client)
{
m_p_iface->del_l2tp_flt_rule(IPA_IP_v4, it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v4],
it_flt->l2tp_second_pass_flt_rule_hdl);
it_flt->l2tp_second_pass_flt_rule_hdl = 0;
IPACMDBG_H("Deleted IPv4 first pass flt rule %d and second pass flt rule %d.\n",
it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v4], it_flt->l2tp_second_pass_flt_rule_hdl);
}
else
#endif
{
m_p_iface->eth_bridge_del_flt_rule(it_flt->flt_rule_hdl[IPA_IP_v4], IPA_IP_v4);
IPACMDBG_H("Deleted IPv4 flt rule %d.\n", it_flt->flt_rule_hdl[IPA_IP_v4]);
}
}
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
#ifdef FEATURE_L2TP
if(m_is_l2tp_iface)
{
m_p_iface->del_l2tp_flt_rule(it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
IPACMDBG_H("Deleted IPv6 flt rule %d.\n", it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
}
else
#endif
{
#ifdef FEATURE_L2TP
if(client->is_l2tp_client)
{
m_p_iface->del_l2tp_flt_rule(IPA_IP_v6, it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6],
it_flt->l2tp_second_pass_flt_rule_hdl);
IPACMDBG_H("Deleted IPv6 first pass flt rule %d and second pass flt rule %d.\n",
it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6], it_flt->l2tp_second_pass_flt_rule_hdl);
}
else
#endif
{
m_p_iface->eth_bridge_del_flt_rule(it_flt->flt_rule_hdl[IPA_IP_v6], IPA_IP_v6);
IPACMDBG_H("Deleted IPv6 flt rule %d.\n", it_flt->flt_rule_hdl[IPA_IP_v6]);
}
}
}
peer->flt_rule.erase(it_flt);
break;
}
}
return;
}
void IPACM_LanToLan_Iface::del_client_rt_rule(peer_iface_info *peer, client_info *client)
{
ipa_hdr_l2_type peer_l2_hdr_type;
int i, num_rules;
peer_l2_hdr_type = peer->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
/* if the peer info is not for intra interface communication */
if(peer->peer != this)
{
IPACMDBG_H("Delete routing rules for inter interface communication.\n");
if(client->is_l2tp_client == false)
{
num_rules = client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v4];
for(i = 0; i < num_rules; i++)
{
m_p_iface->eth_bridge_del_rt_rule(client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v4][i], IPA_IP_v4);
IPACMDBG_H("IPv4 rt rule %d is deleted.\n", client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v4][i]);
}
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v4] = 0;
num_rules = client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v6];
for(i = 0; i < num_rules; i++)
{
m_p_iface->eth_bridge_del_rt_rule(client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v6][i], IPA_IP_v6);
IPACMDBG_H("IPv6 rt rule %d is deleted.\n", client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v6][i]);
}
client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v6] = 0;
#ifdef FEATURE_L2TP
if(IPACM_LanToLan::get_instance()->has_l2tp_iface() == true)
{
m_p_iface->del_l2tp_rt_rule(IPA_IP_v6, client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v6],
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v6]);
}
#endif
}
else
{
#ifdef FEATURE_L2TP
m_p_iface->del_l2tp_rt_rule(IPA_IP_v4, client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_hdl,
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_proc_ctx_hdl[IPA_IP_v4], client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_hdr_hdl,
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v4], client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v4],
client->l2tp_rt_rule_hdl[peer_l2_hdr_type].second_pass_rt_rule_hdl);
m_p_iface->del_l2tp_rt_rule(IPA_IP_v6, 0, client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_hdr_proc_ctx_hdl[IPA_IP_v6],
0, client->l2tp_rt_rule_hdl[peer_l2_hdr_type].num_rt_hdl[IPA_IP_v6], client->l2tp_rt_rule_hdl[peer_l2_hdr_type].first_pass_rt_rule_hdl[IPA_IP_v6],
NULL);
#endif
}
}
else
{
IPACMDBG_H("Delete routing rules for intra interface communication.\n");
num_rules = client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4];
for(i = 0; i < num_rules; i++)
{
m_p_iface->eth_bridge_del_rt_rule(client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4][i], IPA_IP_v4);
IPACMDBG_H("IPv4 rt rule %d is deleted.\n", client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4][i]);
}
client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4] = 0;
num_rules = client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6];
for(i = 0; i < num_rules; i++)
{
m_p_iface->eth_bridge_del_rt_rule(client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6][i], IPA_IP_v6);
IPACMDBG_H("IPv6 rt rule %d is deleted.\n", client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6][i]);
}
client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6] = 0;
}
return;
}
void IPACM_LanToLan_Iface::handle_down_event()
{
list<IPACM_LanToLan_Iface>::iterator it_other_iface;
list<peer_iface_info>::iterator it_own_peer_info, it_other_iface_peer_info;
IPACM_LanToLan_Iface *other_iface;
/* clear inter-interface rules */
if(m_support_inter_iface_offload)
{
for(it_own_peer_info = m_peer_iface_info.begin(); it_own_peer_info != m_peer_iface_info.end();
it_own_peer_info++)
{
/* decrement reference count of peer l2 header type on both interfaces*/
decrement_ref_cnt_peer_l2_hdr_type(it_own_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type);
it_own_peer_info->peer->decrement_ref_cnt_peer_l2_hdr_type(m_p_iface->tx_prop->tx[0].hdr_l2_type);
/* first clear all flt rule on target interface */
IPACMDBG_H("Clear all flt rule on target interface.\n");
clear_all_flt_rule_for_one_peer_iface(&(*it_own_peer_info));
other_iface = it_own_peer_info->peer;
/* then clear all flt/rt rule and hdr proc ctx for target interface on peer interfaces */
IPACMDBG_H("Clear all flt/rt rules and hdr proc ctx for target interface on peer interfaces %s.\n",
it_own_peer_info->peer->get_iface_pointer()->dev_name);
for(it_other_iface_peer_info = other_iface->m_peer_iface_info.begin();
it_other_iface_peer_info != other_iface->m_peer_iface_info.end();
it_other_iface_peer_info++)
{
if(it_other_iface_peer_info->peer == this) //found myself in other iface's peer info list
{
IPACMDBG_H("Found the right peer info on other iface.\n");
other_iface->clear_all_flt_rule_for_one_peer_iface(&(*it_other_iface_peer_info));
other_iface->clear_all_rt_rule_for_one_peer_iface(&(*it_other_iface_peer_info));
/* remove the peer info from the list */
other_iface->m_peer_iface_info.erase(it_other_iface_peer_info);
other_iface->del_hdr_proc_ctx(m_p_iface->tx_prop->tx[0].hdr_l2_type);
break;
}
}
/* then clear rt rule and hdr proc ctx and release rt table on target interface */
IPACMDBG_H("Clear rt rules and hdr proc ctx and release rt table on target interface.\n");
clear_all_rt_rule_for_one_peer_iface(&(*it_own_peer_info));
del_hdr_proc_ctx(it_own_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type);
}
m_peer_iface_info.clear();
}
/* clear intra interface rules */
if(m_support_intra_iface_offload)
{
IPACMDBG_H("Clear intra interface flt/rt rules and hdr proc ctx, release rt tables.\n");
clear_all_flt_rule_for_one_peer_iface(&m_intra_interface_info);
clear_all_rt_rule_for_one_peer_iface(&m_intra_interface_info);
m_p_iface->eth_bridge_del_hdr_proc_ctx(hdr_proc_ctx_for_intra_interface);
IPACMDBG_H("Hdr proc ctx with hdl %d is deleted.\n", hdr_proc_ctx_for_intra_interface);
}
/* then clear the client info list */
m_client_info.clear();
return;
}
void IPACM_LanToLan_Iface::clear_all_flt_rule_for_one_peer_iface(peer_iface_info *peer)
{
list<flt_rule_info>::iterator it;
for(it = peer->flt_rule.begin(); it != peer->flt_rule.end(); it++)
{
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
if(m_is_l2tp_iface)
{
IPACMDBG_H("No IPv4 client flt rule on l2tp iface.\n");
}
else
{
#ifdef FEATURE_L2TP
if(it->p_client->is_l2tp_client)
{
m_p_iface->del_l2tp_flt_rule(IPA_IP_v4, it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v4],
it->l2tp_second_pass_flt_rule_hdl);
it->l2tp_second_pass_flt_rule_hdl = 0;
IPACMDBG_H("Deleted IPv4 first pass flt rule %d and second pass flt rule %d.\n",
it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v4], it->l2tp_second_pass_flt_rule_hdl);
}
else
#endif
{
m_p_iface->eth_bridge_del_flt_rule(it->flt_rule_hdl[IPA_IP_v4], IPA_IP_v4);
IPACMDBG_H("Deleted IPv4 flt rule %d.\n", it->flt_rule_hdl[IPA_IP_v4]);
}
}
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
#ifdef FEATURE_L2TP
if(m_is_l2tp_iface)
{
m_p_iface->del_l2tp_flt_rule(it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
IPACMDBG_H("Deleted IPv6 flt rule %d.\n", it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
}
else
#endif
{
#ifdef FEATURE_L2TP
if(it->p_client->is_l2tp_client)
{
m_p_iface->del_l2tp_flt_rule(IPA_IP_v6, it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6],
it->l2tp_second_pass_flt_rule_hdl);
IPACMDBG_H("Deleted IPv6 first pass flt rule %d and second pass flt rule %d.\n",
it->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6], it->l2tp_second_pass_flt_rule_hdl);
}
else
#endif
{
m_p_iface->eth_bridge_del_flt_rule(it->flt_rule_hdl[IPA_IP_v6], IPA_IP_v6);
IPACMDBG_H("Deleted IPv6 flt rule %d.\n", it->flt_rule_hdl[IPA_IP_v6]);
}
}
}
}
peer->flt_rule.clear();
return;
}
void IPACM_LanToLan_Iface::clear_all_rt_rule_for_one_peer_iface(peer_iface_info *peer)
{
list<client_info>::iterator it;
ipa_hdr_l2_type peer_l2_type;
peer_l2_type = peer->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
if(ref_cnt_peer_l2_hdr_type[peer_l2_type] == 0)
{
for(it = m_client_info.begin(); it != m_client_info.end(); it++)
{
del_client_rt_rule(peer, &(*it));
}
#ifdef FEATURE_L2TP
if(IPACM_LanToLan::get_instance()->has_l2tp_iface() == true)
{
m_p_iface->eth_bridge_del_hdr_proc_ctx(hdr_proc_ctx_for_l2tp);
hdr_proc_ctx_for_l2tp = 0;
}
#endif
}
return;
}
void IPACM_LanToLan_Iface::handle_wlan_scc_mcc_switch()
{
list<peer_iface_info>::iterator it_peer_info;
list<client_info>::iterator it_client;
ipa_hdr_l2_type peer_l2_hdr_type;
bool flag[IPA_HDR_L2_MAX];
int i;
/* modify inter-interface routing rules */
if(m_support_inter_iface_offload)
{
IPACMDBG_H("Modify rt rules for peer interfaces.\n");
memset(flag, 0, sizeof(flag));
for(it_peer_info = m_peer_iface_info.begin(); it_peer_info != m_peer_iface_info.end(); it_peer_info++)
{
peer_l2_hdr_type = it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
if(flag[peer_l2_hdr_type] == false)
{
flag[peer_l2_hdr_type] = true;
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
m_p_iface->eth_bridge_modify_rt_rule(it_client->mac_addr, hdr_proc_ctx_for_inter_interface[peer_l2_hdr_type],
peer_l2_hdr_type, IPA_IP_v4, it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v4],
it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v4]);
IPACMDBG_H("The following IPv4 routing rules are modified:\n");
for(i = 0; i < it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v4]; i++)
{
IPACMDBG_H("%d\n", it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v4][i]);
}
m_p_iface->eth_bridge_modify_rt_rule(it_client->mac_addr, hdr_proc_ctx_for_inter_interface[peer_l2_hdr_type],
peer_l2_hdr_type, IPA_IP_v6, it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v6],
it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v6]);
IPACMDBG_H("The following IPv6 routing rules are modified:\n");
for(i = 0; i < it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].num_hdl[IPA_IP_v6]; i++)
{
IPACMDBG_H("%d\n", it_client->inter_iface_rt_rule_hdl[peer_l2_hdr_type].rule_hdl[IPA_IP_v6][i]);
}
}
}
}
}
/* modify routing rules for intra-interface communication */
IPACMDBG_H("Modify rt rules for intra-interface communication.\n");
if(m_support_intra_iface_offload)
{
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
m_p_iface->eth_bridge_modify_rt_rule(it_client->mac_addr, hdr_proc_ctx_for_intra_interface,
m_p_iface->tx_prop->tx[0].hdr_l2_type, IPA_IP_v4, it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4],
it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4]);
IPACMDBG_H("The following IPv4 routing rules are modified:\n");
for(i = 0; i < it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4]; i++)
{
IPACMDBG_H("%d\n", it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4][i]);
}
m_p_iface->eth_bridge_modify_rt_rule(it_client->mac_addr, hdr_proc_ctx_for_intra_interface,
m_p_iface->tx_prop->tx[0].hdr_l2_type, IPA_IP_v6, it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6],
it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6]);
IPACMDBG_H("The following IPv6 routing rules are modified:\n");
for(i = 0; i < it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6]; i++)
{
IPACMDBG_H("%d\n", it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6][i]);
}
}
}
return;
}
void IPACM_LanToLan_Iface::handle_intra_interface_info()
{
uint32_t hdr_proc_ctx_hdl;
if(m_p_iface->tx_prop == NULL)
{
IPACMERR("No tx prop.\n");
return;
}
m_intra_interface_info.peer = this;
snprintf(m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v4], IPA_RESOURCE_NAME_MAX,
"eth_v4_intra_interface");
IPACMDBG_H("IPv4 routing table for flt name: %s\n", m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v4]);
snprintf(m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v6], IPA_RESOURCE_NAME_MAX,
"eth_v6_intra_interface");
IPACMDBG_H("IPv6 routing table for flt name: %s\n", m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v6]);
memcpy(m_intra_interface_info.rt_tbl_name_for_rt[IPA_IP_v4], m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v4],
IPA_RESOURCE_NAME_MAX);
IPACMDBG_H("IPv4 routing table for rt name: %s\n", m_intra_interface_info.rt_tbl_name_for_rt[IPA_IP_v4]);
memcpy(m_intra_interface_info.rt_tbl_name_for_rt[IPA_IP_v6], m_intra_interface_info.rt_tbl_name_for_flt[IPA_IP_v6],
IPA_RESOURCE_NAME_MAX);
IPACMDBG_H("IPv6 routing table for rt name: %s\n", m_intra_interface_info.rt_tbl_name_for_rt[IPA_IP_v6]);
m_p_iface->eth_bridge_add_hdr_proc_ctx(m_p_iface->tx_prop->tx[0].hdr_l2_type,
&hdr_proc_ctx_hdl);
hdr_proc_ctx_for_intra_interface = hdr_proc_ctx_hdl;
IPACMDBG_H("Hdr proc ctx for intra-interface communication: hdl %d\n", hdr_proc_ctx_hdl);
return;
}
void IPACM_LanToLan_Iface::handle_new_iface_up(char rt_tbl_name_for_flt[][IPA_RESOURCE_NAME_MAX], char rt_tbl_name_for_rt[][IPA_RESOURCE_NAME_MAX],
IPACM_LanToLan_Iface *peer_iface)
{
peer_iface_info new_peer;
ipa_hdr_l2_type peer_l2_hdr_type;
new_peer.peer = peer_iface;
memcpy(new_peer.rt_tbl_name_for_rt[IPA_IP_v4], rt_tbl_name_for_rt[IPA_IP_v4], IPA_RESOURCE_NAME_MAX);
memcpy(new_peer.rt_tbl_name_for_rt[IPA_IP_v6], rt_tbl_name_for_rt[IPA_IP_v6], IPA_RESOURCE_NAME_MAX);
memcpy(new_peer.rt_tbl_name_for_flt[IPA_IP_v4], rt_tbl_name_for_flt[IPA_IP_v4], IPA_RESOURCE_NAME_MAX);
memcpy(new_peer.rt_tbl_name_for_flt[IPA_IP_v6], rt_tbl_name_for_flt[IPA_IP_v6], IPA_RESOURCE_NAME_MAX);
peer_l2_hdr_type = peer_iface->m_p_iface->tx_prop->tx[0].hdr_l2_type;
increment_ref_cnt_peer_l2_hdr_type(peer_l2_hdr_type);
add_hdr_proc_ctx(peer_l2_hdr_type);
/* push the new peer_iface_info into the list */
m_peer_iface_info.push_front(new_peer);
return;
}
void IPACM_LanToLan_Iface::handle_client_add(uint8_t *mac,
bool is_l2tp_client,
l2tp_vlan_mapping_info *mapping_info,
int ep)
{
list<client_info>::iterator it_client;
list<peer_iface_info>::iterator it_peer_info;
client_info new_client;
bool flag[IPA_HDR_L2_MAX];
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
if((memcmp(it_client->mac_addr, mac, sizeof(it_client->mac_addr)) == 0))
{
IPACMDBG_H("This client has been added before.\n");
return;
}
}
if(m_client_info.size() == MAX_NUM_CLIENT)
{
IPACMDBG_H("The number of clients has reached maximum %d.\n", MAX_NUM_CLIENT);
return;
}
IPACMDBG_H("is_l2tp_client: %d, mapping_info: %p\n", is_l2tp_client, mapping_info);
memset(&new_client, 0, sizeof(new_client));
memcpy(new_client.mac_addr, mac, sizeof(new_client.mac_addr));
new_client.is_l2tp_client = is_l2tp_client;
new_client.mapping_info = mapping_info;
new_client.ep = ep;
m_client_info.push_front(new_client);
client_info &front_client = m_client_info.front();
/* install inter-interface rules */
if(m_support_inter_iface_offload)
{
memset(flag, 0, sizeof(flag));
for(it_peer_info = m_peer_iface_info.begin(); it_peer_info != m_peer_iface_info.end(); it_peer_info++)
{
/* make sure add routing rule only once for each peer l2 header type */
if(flag[it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type] == false)
{
/* add client routing rule for each peer interface */
if(front_client.is_l2tp_client == false)
{
add_client_rt_rule(&(*it_peer_info), &front_client);
}
#ifdef FEATURE_L2TP
/* add l2tp rt rules */
add_l2tp_client_rt_rule(&(*it_peer_info), &front_client);
#endif
flag[it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type] = true;
}
/* add client filtering rule on peer interfaces */
it_peer_info->peer->add_one_client_flt_rule(this, &front_client);
}
}
/* install intra-interface rules */
if(m_support_intra_iface_offload)
{
/* add routing rule first */
add_client_rt_rule(&m_intra_interface_info, &front_client);
/* add filtering rule */
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
add_client_flt_rule(&m_intra_interface_info, &front_client, IPA_IP_v4);
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
add_client_flt_rule(&m_intra_interface_info, &front_client, IPA_IP_v6);
}
}
return;
}
void IPACM_LanToLan_Iface::handle_client_del(uint8_t *mac)
{
list<client_info>::iterator it_client;
list<peer_iface_info>::iterator it_peer_info;
bool flag[IPA_HDR_L2_MAX];
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
if(memcmp(it_client->mac_addr, mac, sizeof(it_client->mac_addr)) == 0) //found the client
{
IPACMDBG_H("Found the client.\n");
break;
}
}
if(it_client != m_client_info.end()) //if we found the client
{
/* uninstall inter-interface rules */
if(m_support_inter_iface_offload)
{
memset(flag, 0, sizeof(flag));
for(it_peer_info = m_peer_iface_info.begin(); it_peer_info != m_peer_iface_info.end();
it_peer_info++)
{
IPACMDBG_H("Delete client filtering rule on peer interface.\n");
it_peer_info->peer->del_one_client_flt_rule(this, &(*it_client));
/* make sure to delete routing rule only once for each peer l2 header type */
if(flag[it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type] == false)
{
IPACMDBG_H("Delete client routing rule for peer interface.\n");
del_client_rt_rule(&(*it_peer_info), &(*it_client));
#ifdef FEATURE_L2TP
if(it_client->is_l2tp_client == false && IPACM_LanToLan::get_instance()->has_l2tp_iface() == true
&& m_client_info.size() == 1)
{
m_p_iface->eth_bridge_del_hdr_proc_ctx(hdr_proc_ctx_for_l2tp);
hdr_proc_ctx_for_l2tp = 0;
}
#endif
flag[it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type] = true;
}
}
}
/* uninstall intra-interface rules */
if(m_support_intra_iface_offload)
{
/* delete filtering rule first */
IPACMDBG_H("Delete client filtering rule for intra-interface communication.\n");
del_client_flt_rule(&m_intra_interface_info, &(*it_client));
/* delete routing rule */
IPACMDBG_H("Delete client routing rule for intra-interface communication.\n");
del_client_rt_rule(&m_intra_interface_info, &(*it_client));
}
/* erase the client from client info list */
m_client_info.erase(it_client);
}
else
{
IPACMDBG_H("The client is not found.\n");
}
return;
}
void IPACM_LanToLan_Iface::add_hdr_proc_ctx(ipa_hdr_l2_type peer_l2_type)
{
uint32_t hdr_proc_ctx_hdl;
if(ref_cnt_peer_l2_hdr_type[peer_l2_type] == 1)
{
m_p_iface->eth_bridge_add_hdr_proc_ctx(peer_l2_type, &hdr_proc_ctx_hdl);
hdr_proc_ctx_for_inter_interface[peer_l2_type] = hdr_proc_ctx_hdl;
IPACMDBG_H("Installed inter-interface hdr proc ctx on iface %s: handle %d\n", m_p_iface->dev_name, hdr_proc_ctx_hdl);
}
return;
}
void IPACM_LanToLan_Iface::del_hdr_proc_ctx(ipa_hdr_l2_type peer_l2_type)
{
if(ref_cnt_peer_l2_hdr_type[peer_l2_type] == 0)
{
m_p_iface->eth_bridge_del_hdr_proc_ctx(hdr_proc_ctx_for_inter_interface[peer_l2_type]);
IPACMDBG_H("Hdr proc ctx with hdl %d is deleted.\n", hdr_proc_ctx_for_inter_interface[peer_l2_type]);
}
return;
}
void IPACM_LanToLan_Iface::print_data_structure_info()
{
list<peer_iface_info>::iterator it_peer;
list<client_info>::iterator it_client;
int i, j, k;
IPACMDBG_H("\n");
IPACMDBG_H("Interface %s:\n", m_p_iface->dev_name);
IPACMDBG_H("Is IPv4 addr assigned? %d\n", m_is_ip_addr_assigned[IPA_IP_v4]);
IPACMDBG_H("Is IPv6 addr assigned? %d\n", m_is_ip_addr_assigned[IPA_IP_v6]);
IPACMDBG_H("Support inter interface offload? %d\n", m_support_inter_iface_offload);
IPACMDBG_H("Support intra interface offload? %d\n", m_support_intra_iface_offload);
IPACMDBG_H("Is l2tp interface? %d\n", m_is_l2tp_iface);
if(m_support_inter_iface_offload)
{
for(i = 0; i < IPA_HDR_L2_MAX; i++)
{
IPACMDBG_H("Ref_cnt of peer l2 type %s is %d.\n", ipa_l2_hdr_type[i], ref_cnt_peer_l2_hdr_type[i]);
if(ref_cnt_peer_l2_hdr_type[i] > 0)
{
IPACMDBG_H("Hdr proc ctx for peer l2 type %s: %d\n", ipa_l2_hdr_type[i], hdr_proc_ctx_for_inter_interface[i]);
}
}
}
if(m_support_intra_iface_offload)
{
IPACMDBG_H("Hdr proc ctx for intra-interface: %d\n", hdr_proc_ctx_for_intra_interface);
}
IPACMDBG_H("Hdr proc ctx for l2tp: %d\n", hdr_proc_ctx_for_l2tp);
i = 1;
IPACMDBG_H("There are %zu clients in total.\n", m_client_info.size());
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
IPACMDBG_H("Client %d MAC: 0x%02x%02x%02x%02x%02x%02x Pointer: 0x%p\n", i, it_client->mac_addr[0], it_client->mac_addr[1],
it_client->mac_addr[2], it_client->mac_addr[3], it_client->mac_addr[4], it_client->mac_addr[5], &(*it_client));
IPACMDBG_H("Is l2tp client? %d\n", it_client->is_l2tp_client);
if(it_client->is_l2tp_client && it_client->mapping_info)
{
IPACMDBG_H("Vlan iface associated with this client: %s\n", it_client->mapping_info->vlan_iface_name);
}
if(m_support_inter_iface_offload)
{
for(j = 0; j < IPA_HDR_L2_MAX; j++)
{
if(ref_cnt_peer_l2_hdr_type[j] > 0)
{
IPACMDBG_H("Printing routing rule info for inter-interface communication for peer l2 type %s.\n",
ipa_l2_hdr_type[j]);
IPACMDBG_H("Number of IPv4 routing rules is %d, handles:\n", it_client->inter_iface_rt_rule_hdl[j].num_hdl[IPA_IP_v4]);
for(k = 0; k < it_client->inter_iface_rt_rule_hdl[j].num_hdl[IPA_IP_v4]; k++)
{
IPACMDBG_H("%d\n", it_client->inter_iface_rt_rule_hdl[j].rule_hdl[IPA_IP_v4][k]);
}
IPACMDBG_H("Number of IPv6 routing rules is %d, handles:\n", it_client->inter_iface_rt_rule_hdl[j].num_hdl[IPA_IP_v6]);
for(k = 0; k < it_client->inter_iface_rt_rule_hdl[j].num_hdl[IPA_IP_v6]; k++)
{
IPACMDBG_H("%d\n", it_client->inter_iface_rt_rule_hdl[j].rule_hdl[IPA_IP_v6][k]);
}
#ifdef FEATURE_L2TP
if(it_client->is_l2tp_client)
{
IPACMDBG_H("Printing l2tp hdr info for l2tp client.\n");
IPACMDBG_H("First pass hdr hdl: %d, IPv4 hdr proc ctx hdl: IPv6 hdr proc ctx hdl: %d\n",
it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_hdl, it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_proc_ctx_hdl[IPA_IP_v4],
it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_proc_ctx_hdl[IPA_IP_v6]);
IPACMDBG_H("Second pass hdr hdl: %d\n", it_client->l2tp_rt_rule_hdl[j].second_pass_hdr_hdl);
IPACMDBG_H("Printing l2tp routing rule info for l2tp client.\n");
IPACMDBG_H("Number of IPv4 routing rules is %d, first pass handles:\n", it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v4]);
for(k = 0; k < it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v4]; k++)
{
IPACMDBG_H("%d\n", it_client->l2tp_rt_rule_hdl[j].first_pass_rt_rule_hdl[IPA_IP_v4][k]);
}
IPACMDBG_H("Number of IPv6 routing rules is %d, first pass handles:\n", it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v6]);
for(k = 0; k < it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v6]; k++)
{
IPACMDBG_H("%d\n", it_client->l2tp_rt_rule_hdl[j].first_pass_rt_rule_hdl[IPA_IP_v6][k]);
}
IPACMDBG_H("Second pass handles:\n");
for(k = 0; k < it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v6]; k++)
{
IPACMDBG_H("%d\n", it_client->l2tp_rt_rule_hdl[j].second_pass_rt_rule_hdl[k]);
}
}
else
{
if(IPACM_LanToLan::get_instance()->has_l2tp_iface())
{
IPACMDBG_H("Printing l2tp hdr info for non l2tp client.\n");
IPACMDBG_H("Hdr hdl: %d, IPv4 hdr proc ctx hdl: IPv6 hdr proc ctx hdl: %d\n",
it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_hdl, it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_proc_ctx_hdl[IPA_IP_v4],
it_client->l2tp_rt_rule_hdl[j].first_pass_hdr_proc_ctx_hdl[IPA_IP_v6]);
IPACMDBG_H("Printing l2tp routing rule info for non l2tp client.\n");
IPACMDBG_H("Number of IPv4 routing rules is %d, handles:\n", it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v4]);
for(k = 0; k < it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v4]; k++)
{
IPACMDBG_H("%d\n", it_client->l2tp_rt_rule_hdl[j].first_pass_rt_rule_hdl[IPA_IP_v4][k]);
}
IPACMDBG_H("Number of IPv6 routing rules is %d, handles:\n", it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v6]);
for(k = 0; k < it_client->l2tp_rt_rule_hdl[j].num_rt_hdl[IPA_IP_v6]; k++)
{
IPACMDBG_H("%d\n", it_client->l2tp_rt_rule_hdl[j].first_pass_rt_rule_hdl[IPA_IP_v6][k]);
}
}
}
#endif
}
}
}
if(m_support_intra_iface_offload)
{
IPACMDBG_H("Printing routing rule info for intra-interface communication.\n");
IPACMDBG_H("Number of IPv4 routing rules is %d, handles:\n", it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4]);
for(j = 0; j < it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v4]; j++)
{
IPACMDBG_H("%d\n", it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v4][j]);
}
IPACMDBG_H("Number of IPv6 routing rules is %d, handles:\n", it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6]);
for(j = 0; j < it_client->intra_iface_rt_rule_hdl.num_hdl[IPA_IP_v6]; j++)
{
IPACMDBG_H("%d\n", it_client->intra_iface_rt_rule_hdl.rule_hdl[IPA_IP_v6][j]);
}
}
i++;
}
IPACMDBG_H("There are %zu peer interfaces in total.\n", m_peer_iface_info.size());
for(it_peer = m_peer_iface_info.begin(); it_peer != m_peer_iface_info.end(); it_peer++)
{
print_peer_info(&(*it_peer));
}
if(m_support_intra_iface_offload)
{
IPACMDBG_H("This interface supports intra-interface communication, printing info:\n");
print_peer_info(&m_intra_interface_info);
}
return;
}
void IPACM_LanToLan_Iface::print_peer_info(peer_iface_info *peer_info)
{
list<flt_rule_info>::iterator it_flt;
list<rt_rule_info>::iterator it_rt;
IPACMDBG_H("Printing peer info for iface %s:\n", peer_info->peer->m_p_iface->dev_name);
IPACMDBG_H("There are %zu flt info in total.\n", peer_info->flt_rule.size());
for(it_flt = peer_info->flt_rule.begin(); it_flt != peer_info->flt_rule.end(); it_flt++)
{
IPACMDBG_H("Flt rule handle for client 0x%p:\n", it_flt->p_client);
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
IPACMDBG_H("IPv4 %d\n", it_flt->flt_rule_hdl[IPA_IP_v4]);
IPACMDBG_H("IPv4 l2tp first pass flt rule: %d\n", it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v4]);
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
IPACMDBG_H("IPv6 %d\n", it_flt->flt_rule_hdl[IPA_IP_v6]);
IPACMDBG_H("IPv6 l2tp first pass flt rule: %d\n", it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
}
IPACMDBG_H("L2tp second pass flt rule: %d\n", it_flt->l2tp_second_pass_flt_rule_hdl);
}
return;
}
IPACM_Lan* IPACM_LanToLan_Iface::get_iface_pointer()
{
return m_p_iface;
}
bool IPACM_LanToLan_Iface::get_m_is_ip_addr_assigned(ipa_ip_type iptype)
{
IPACMDBG_H("Has IP address been assigned to interface %s for IP type %d? %d\n",
m_p_iface->dev_name, iptype, m_is_ip_addr_assigned[iptype]);
return m_is_ip_addr_assigned[iptype];
}
void IPACM_LanToLan_Iface::set_m_is_ip_addr_assigned(ipa_ip_type iptype, bool value)
{
IPACMDBG_H("Is IP address of IP type %d assigned to interface %s? %d\n", iptype,
m_p_iface->dev_name, value);
m_is_ip_addr_assigned[iptype] = value;
}
bool IPACM_LanToLan_Iface::get_m_support_inter_iface_offload()
{
IPACMDBG_H("Support inter interface offload on %s? %d\n", m_p_iface->dev_name,
m_support_inter_iface_offload);
return m_support_inter_iface_offload;
}
bool IPACM_LanToLan_Iface::get_m_support_intra_iface_offload()
{
IPACMDBG_H("Support intra interface offload on %s? %d\n", m_p_iface->dev_name,
m_support_intra_iface_offload);
return m_support_intra_iface_offload;
}
void IPACM_LanToLan_Iface::increment_ref_cnt_peer_l2_hdr_type(ipa_hdr_l2_type peer_l2_type)
{
ref_cnt_peer_l2_hdr_type[peer_l2_type]++;
IPACMDBG_H("Now the ref_cnt of peer l2 hdr type %s is %d.\n", ipa_l2_hdr_type[peer_l2_type],
ref_cnt_peer_l2_hdr_type[peer_l2_type]);
return;
}
void IPACM_LanToLan_Iface::decrement_ref_cnt_peer_l2_hdr_type(ipa_hdr_l2_type peer_l2_type)
{
ref_cnt_peer_l2_hdr_type[peer_l2_type]--;
IPACMDBG_H("Now the ref_cnt of peer l2 hdr type %s is %d.\n", ipa_l2_hdr_type[peer_l2_type],
ref_cnt_peer_l2_hdr_type[peer_l2_type]);
return;
}
#ifdef FEATURE_L2TP
bool IPACM_LanToLan_Iface::set_l2tp_iface(char *vlan_iface_name)
{
IPACMDBG_H("Self iface %s, vlan iface %s\n", m_p_iface->dev_name,
vlan_iface_name);
if(m_is_l2tp_iface == false)
{
if(strncmp(m_p_iface->dev_name, vlan_iface_name, strlen(m_p_iface->dev_name)) == 0)
{
IPACMDBG_H("This interface is l2tp interface.\n");
m_is_l2tp_iface = true;
}
}
return m_is_l2tp_iface;
}
bool IPACM_LanToLan_Iface::is_l2tp_iface()
{
return m_is_l2tp_iface;
}
void IPACM_LanToLan_Iface::switch_to_l2tp_iface()
{
list<peer_iface_info>::iterator it_peer;
list<flt_rule_info>::iterator it_flt;
for(it_peer = m_peer_iface_info.begin(); it_peer != m_peer_iface_info.end(); it_peer++)
{
for(it_flt = it_peer->flt_rule.begin(); it_flt != it_peer->flt_rule.end(); it_flt++)
{
if(m_is_ip_addr_assigned[IPA_IP_v4])
{
m_p_iface->eth_bridge_del_flt_rule(it_flt->flt_rule_hdl[IPA_IP_v4], IPA_IP_v4);
IPACMDBG_H("Deleted IPv4 flt rule %d.\n", it_flt->flt_rule_hdl[IPA_IP_v4]);
}
if(m_is_ip_addr_assigned[IPA_IP_v6])
{
m_p_iface->eth_bridge_del_flt_rule(it_flt->flt_rule_hdl[IPA_IP_v6], IPA_IP_v6);
m_p_iface->add_l2tp_flt_rule(it_flt->p_client->mac_addr, &it_flt->l2tp_first_pass_flt_rule_hdl[IPA_IP_v6]);
IPACMDBG_H("Deleted IPv6 flt rule %d.\n", it_flt->flt_rule_hdl[IPA_IP_v6]);
}
}
}
return;
}
void IPACM_LanToLan_Iface::handle_l2tp_enable()
{
int i;
ipa_hdr_l2_type peer_l2_hdr_type;
list<peer_iface_info>::iterator it_peer_info;
list<client_info>::iterator it_client;
bool flag[IPA_HDR_L2_MAX];
if(m_support_inter_iface_offload)
{
memset(flag, 0, sizeof(flag));
for(it_peer_info = m_peer_iface_info.begin(); it_peer_info != m_peer_iface_info.end(); it_peer_info++)
{
if(it_peer_info->peer->is_l2tp_iface())
{
peer_l2_hdr_type = it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
flag[peer_l2_hdr_type] = true;
}
}
for(i = 0; i < IPA_HDR_L2_MAX; i++)
{
if(flag[i] == true)
{
IPACMDBG_H("Add rt rule for peer l2 type %s\n", ipa_l2_hdr_type[i]);
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
m_p_iface->add_l2tp_rt_rule(IPA_IP_v6, it_client->mac_addr, &hdr_proc_ctx_for_l2tp,
&it_client->l2tp_rt_rule_hdl[i].num_rt_hdl[IPA_IP_v6],
it_client->l2tp_rt_rule_hdl[i].first_pass_rt_rule_hdl[IPA_IP_v6]);
}
}
}
}
return;
}
void IPACM_LanToLan_Iface::handle_l2tp_disable()
{
int i;
ipa_hdr_l2_type peer_l2_hdr_type;
list<peer_iface_info>::iterator it_peer_info;
list<client_info>::iterator it_client;
bool flag[IPA_HDR_L2_MAX];
if(m_support_inter_iface_offload)
{
memset(flag, 0, sizeof(flag));
for(it_peer_info = m_peer_iface_info.begin(); it_peer_info != m_peer_iface_info.end(); it_peer_info++)
{
peer_l2_hdr_type = it_peer_info->peer->get_iface_pointer()->tx_prop->tx[0].hdr_l2_type;
flag[peer_l2_hdr_type] = true;
}
for(i = 0; i < IPA_HDR_L2_MAX; i++)
{
if(flag[i] == true)
{
IPACMDBG_H("Delete rt rule for peer l2 type %s\n", ipa_l2_hdr_type[i]);
for(it_client = m_client_info.begin(); it_client != m_client_info.end(); it_client++)
{
m_p_iface->del_l2tp_rt_rule(IPA_IP_v6, it_client->l2tp_rt_rule_hdl[i].num_rt_hdl[IPA_IP_v6],
it_client->l2tp_rt_rule_hdl[i].first_pass_rt_rule_hdl[IPA_IP_v6]);
}
}
}
}
return;
}
#endif
Reference in a new issue View git blame Copy permalink