| /******************************************************************************* |
| Copyright (C) Marvell International Ltd. and its affiliates |
| |
| This software file (the "File") is owned and distributed by Marvell |
| International Ltd. and/or its affiliates ("Marvell") under the following |
| alternative licensing terms. Once you have made an election to distribute the |
| File under one of the following license alternatives, please (i) delete this |
| introductory statement regarding license alternatives, (ii) delete the two |
| license alternatives that you have not elected to use and (iii) preserve the |
| Marvell copyright notice above. |
| |
| ******************************************************************************** |
| Marvell Commercial License Option |
| |
| If you received this File from Marvell and you have entered into a commercial |
| license agreement (a "Commercial License") with Marvell, the File is licensed |
| to you under the terms of the applicable Commercial License. |
| |
| ******************************************************************************** |
| Marvell GPL License Option |
| |
| If you received this File from Marvell, you may opt to use, redistribute and/or |
| modify this File in accordance with the terms and conditions of the General |
| Public License Version 2, June 1991 (the "GPL License"), a copy of which is |
| available along with the File in the license.txt file or by writing to the Free |
| Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 or |
| on the worldwide web at http://www.gnu.org/licenses/gpl.txt. |
| |
| THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE IMPLIED |
| WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE ARE EXPRESSLY |
| DISCLAIMED. The GPL License provides additional details about this warranty |
| disclaimer. |
| ******************************************************************************** |
| Marvell BSD License Option |
| |
| If you received this File from Marvell, you may opt to use, redistribute and/or |
| modify this File under the following licensing terms. |
| 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 Marvell 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 BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
| ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 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. |
| ******************************************************************************** |
| * mv_cph_app.c |
| * |
| * DESCRIPTION: Marvell CPH(CPH Packet Handler) application module to implement |
| * CPH main logic and handle application packets such as OMCI, eOAM, |
| * IGMP packets. |
| * |
| * DEPENDENCIES: |
| * None |
| * |
| * CREATED BY: VictorGu |
| * |
| * DATE CREATED: 22Jan2013 |
| * |
| * FILE REVISION NUMBER: |
| * Revision: 1.0 |
| * |
| * |
| *******************************************************************************/ |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/version.h> |
| #include <linux/delay.h> |
| #include <linux/wait.h> |
| #include <linux/mutex.h> |
| #include <linux/spinlock.h> |
| #include <linux/poll.h> |
| #include <linux/clk.h> |
| #include <linux/fs.h> |
| #include <linux/vmalloc.h> |
| #include <linux/cdev.h> |
| #include <linux/device.h> |
| #include <linux/miscdevice.h> |
| #include <linux/netdevice.h> |
| #include <linux/etherdevice.h> |
| #include <linux/skbuff.h> |
| #include <linux/if_vlan.h> |
| #include <net/ip.h> |
| #include <net/ipv6.h> |
| |
| #include "mv_cph_header.h" |
| |
| |
| /****************************************************************************** |
| * Variable Definition |
| ******************************************************************************/ |
| /* CPH global trace flag */ |
| UINT32 g_cph_global_trace = CPH_ERR_LEVEL|CPH_WARN_LEVEL|CPH_INFO_LEVEL; |
| |
| MV_ENUM_ENTRY_T g_enum_map_profile_id[] = |
| { |
| { TPM_PON_WAN_DUAL_MAC_INT_SWITCH, "TPM_PON_WAN_DUAL_MAC_INT_SWITCH"}, |
| { TPM_PON_WAN_G0_INT_SWITCH, "TPM_PON_WAN_G0_INT_SWITCH"}, |
| { TPM_PON_WAN_G1_LAN_G0_INT_SWITCH, "TPM_PON_WAN_G1_LAN_G0_INT_SWITCH"}, |
| { TPM_G0_WAN_G1_INT_SWITCH, "TPM_G0_WAN_G1_INT_SWITCH"}, |
| { TPM_G1_WAN_G0_INT_SWITCH, "TPM_G1_WAN_G0_INT_SWITCH"}, |
| { TPM_PON_G1_WAN_G0_INT_SWITCH, "TPM_PON_G1_WAN_G0_INT_SWITCH"}, |
| { TPM_PON_G0_WAN_G1_INT_SWITCH, "TPM_PON_G0_WAN_G1_INT_SWITCH"}, |
| { TPM_PON_WAN_DUAL_MAC_EXT_SWITCH, "TPM_PON_WAN_DUAL_MAC_EXT_SWITCH"}, |
| { TPM_PON_WAN_G1_MNG_EXT_SWITCH, "TPM_PON_WAN_G1_MNG_EXT_SWITCH"}, |
| { TPM_PON_WAN_G0_SINGLE_PORT, "TPM_PON_WAN_G0_SINGLE_PORT"}, |
| { TPM_PON_WAN_G1_SINGLE_PORT, "TPM_PON_WAN_G1_SINGLE_PORT"}, |
| { TPM_PON_G1_WAN_G0_SINGLE_PORT, "TPM_PON_G1_WAN_G0_SINGLE_PORT"}, |
| { TPM_PON_G0_WAN_G1_SINGLE_PORT, "TPM_PON_G0_WAN_G1_SINGLE_PORTg"}, |
| { TPM_PON_WAN_G0_G1_LPBK, "TPM_PON_WAN_G0_G1_LPBK"}, |
| { TPM_PON_WAN_G0_G1_DUAL_LAN, "TPM_PON_WAN_G0_G1_DUAL_LAN"}, |
| { TPM_PON_WAN_G0_SINGLE_PORT_SGMII, "TPM_PON_WAN_G0_SINGLE_PORT_SGMII"}, |
| { TPM_PON_G1_SGMII_WAN_G0_SINGLE_PORT, "TPM_PON_G1_SGMII_WAN_G0_SINGLE_PORT"}, |
| }; |
| |
| static MV_ENUM_ARRAY_T g_enum_array_profile_id = |
| { |
| sizeof(g_enum_map_profile_id)/sizeof(g_enum_map_profile_id[0]), |
| g_enum_map_profile_id |
| }; |
| |
| static MV_ENUM_ENTRY_T g_enum_map_pon_type[] = |
| { |
| { CPH_PON_TYPE_EPON, "EPON"}, |
| { CPH_PON_TYPE_GPON, "GPON"}, |
| { CPH_PON_TYPE_GBE, "GBE"}, |
| { CPH_PON_TYPE_P2P, "P2P"}, |
| }; |
| |
| static MV_ENUM_ARRAY_T g_enum_array_pon_type = |
| { |
| sizeof(g_enum_map_pon_type)/sizeof(g_enum_map_pon_type[0]), |
| g_enum_map_pon_type |
| }; |
| |
| static MV_ENUM_ENTRY_T g_enum_map_dir[] = |
| { |
| { CPH_DIR_US, "US"}, |
| { CPH_DIR_DS, "DS"}, |
| { CPH_DIR_NOT_CARE, "Not Care"}, |
| }; |
| |
| static MV_ENUM_ARRAY_T g_enum_array_dir = |
| { |
| sizeof(g_enum_map_dir)/sizeof(g_enum_map_dir[0]), |
| g_enum_map_dir |
| }; |
| |
| static MV_ENUM_ENTRY_T g_enum_map_rx_tx[] = |
| { |
| { CPH_DIR_RX, "RX"}, |
| { CPH_DIR_TX, "TX"}, |
| { CPH_RX_TX_NOT_CARE, "Not Care"}, |
| }; |
| |
| static MV_ENUM_ARRAY_T g_enum_array_rx_tx = |
| { |
| sizeof(g_enum_map_rx_tx)/sizeof(g_enum_map_rx_tx[0]), |
| g_enum_map_rx_tx |
| }; |
| |
| static MV_ENUM_ENTRY_T g_enum_map_gmac[] = |
| { |
| { MV_APP_GMAC_PORT_0, "GMAC0"}, |
| { MV_APP_GMAC_PORT_1, "GMAC1"}, |
| { MV_APP_PON_MAC_PORT, "PON MAC"}, |
| }; |
| |
| static MV_ENUM_ARRAY_T g_enum_array_gmac = |
| { |
| sizeof(g_enum_map_gmac)/sizeof(g_enum_map_gmac[0]), |
| g_enum_map_gmac |
| }; |
| |
| |
| /****************************************************************************** |
| * External Declaration |
| ******************************************************************************/ |
| extern CHAR *cph_lookup_enum_str(MV_ENUM_ARRAY_T *p_enum_array, INT32 enum_value); |
| |
| |
| /****************************************************************************** |
| * Function Definition |
| ******************************************************************************/ |
| /****************************************************************************** |
| * cph_app_set_complex_profile() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Set TPM complex profile ID |
| * |
| * INPUTS: |
| * profile_id - TPM complex profile ID |
| * active_port - Active WAN port |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_set_complex_profile (tpm_eth_complex_profile_t profile_id, MV_APP_GMAC_PORT_E active_port) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| /* Check the range of profile_id */ |
| if (profile_id >= TPM_COMPLEX_PROFILE_LAST) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "profile_id[%d] is out of range[1~%d] \n", profile_id, TPM_COMPLEX_PROFILE_LAST-1); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| /* Check the range of active_port */ |
| if (active_port > MV_APP_PON_MAC_PORT) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "active_port[%d] is out of range[0~%d] \n", active_port, MV_APP_PON_MAC_PORT); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| rc = cph_db_set_param(CPH_DB_PARAM_PROFILE_ID, &profile_id); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_set_param"); |
| |
| rc = cph_db_set_param(CPH_DB_PARAM_ACTIVE_PORT, &active_port); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_set_param"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_set_feature_flag() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Enable or disable feature support in CPH |
| * |
| * INPUTS: |
| * feature - CPH supported features |
| * state - Enable or disable this feature in CPH |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_set_feature_flag (CPH_APP_FEATURE_E feature, BOOL state) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| switch (feature) |
| { |
| case CPH_APP_FEATURE_APP: |
| cph_db_set_param(CPH_DB_PARAM_APP_SUPPORT, &state); |
| break; |
| case CPH_APP_FEATURE_IGMP: |
| cph_db_set_param(CPH_DB_PARAM_IGMP_SUPPORT,&state); |
| break; |
| case CPH_APP_FEATURE_BC: |
| cph_db_set_param(CPH_DB_PARAM_BC_SUPPORT, &state); |
| break; |
| case CPH_APP_FEATURE_FLOW: |
| cph_db_set_param(CPH_DB_PARAM_FLOW_SUPPORT,&state); |
| break; |
| case CPH_APP_FEATURE_UDP: |
| cph_db_set_param(CPH_DB_PARAM_UDP_SUPPORT, &state); |
| break; |
| default: |
| break; |
| } |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_validate_parse_field() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Validate the parsing filed of CPH rule |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_validate_parse_field ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| /* Check the range of parse_bm */ |
| if (parse_bm >= CPH_APP_PARSE_FIELD_END) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x] is out of range[0x01~0x%x] \n", parse_bm, CPH_APP_PARSE_FIELD_END); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| /* Validate direction */ |
| if (parse_bm & CPH_APP_PARSE_FIELD_DIR) |
| { |
| if (parse_key->dir > CPH_DIR_NOT_CARE) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "dir[%d] is out of range[0~%d] \n", parse_key->dir, CPH_DIR_NOT_CARE); |
| return MV_OUT_OF_RANGE; |
| } |
| } |
| |
| /* Validate RX/TX direction */ |
| if (parse_bm & CPH_APP_PARSE_FIELD_RX_TX) |
| { |
| if (parse_key->rx_tx > CPH_RX_TX_NOT_CARE) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "rx_tx[%d] is out of range[0~%d] \n", parse_key->rx_tx, CPH_RX_TX_NOT_CARE); |
| return MV_OUT_OF_RANGE; |
| } |
| } |
| |
| /* Could not parse None IPv4 Eth type and IPv4 protocol type at the same ime */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_ETH_TYPE) && |
| (parse_bm & CPH_APP_PARSE_FIELD_IPV4_TYPE) && |
| (parse_key->eth_type != MV_CPH_ETH_TYPE_IPV4)) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], eth_type[0x%x], does not support parsing None IPv4 Eth type and IPv4 protocol type at the same time\n", |
| parse_bm, parse_key->eth_type); |
| return MV_BAD_VALUE; |
| } |
| |
| /* Could not parse None IPv6 Eth type and IPv4 protocol type at the same ime */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_ETH_TYPE) && |
| ((parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH1) || |
| (parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH2) || |
| (parse_bm & CPH_APP_PARSE_FIELD_ICMPV6_TYPE)) && |
| (parse_key->eth_type != MV_CPH_ETH_TYPE_IPV6)) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], eth_type[0x%x], does not support parsing None IPv6 Eth type and IPv6 NH or ICMP type at the same time\n", |
| parse_bm, parse_key->eth_type); |
| return MV_BAD_VALUE; |
| } |
| |
| /* Could not parse Eth subtype and IPv4 the same time */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_ETH_SUBTYPE) && |
| (parse_bm & CPH_APP_PARSE_FIELD_IPV4_TYPE)) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], does not support parsing Eth subtype and IPv4 type at the same time \n", parse_bm); |
| return MV_BAD_VALUE; |
| } |
| |
| /* Could not parse Eth subtype and IPv6 the same time */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_ETH_SUBTYPE) && |
| ((parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH1) || |
| (parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH2) || |
| (parse_bm & CPH_APP_PARSE_FIELD_ICMPV6_TYPE))) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], does not support parsing Eth subtype and IPv6 type at the same time \n", parse_bm); |
| return MV_BAD_VALUE; |
| } |
| |
| /* Could not parse IPv4 and IPv6 at the same time */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_IPV4_TYPE) && |
| ((parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH1) || |
| (parse_bm & CPH_APP_PARSE_FIELD_IPV6_NH2) || |
| (parse_bm & CPH_APP_PARSE_FIELD_ICMPV6_TYPE))) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], does not support parsing IPv4 and IPv6 type at the same time\n", parse_bm); |
| return MV_BAD_VALUE; |
| } |
| |
| /* Validate IGMPv6 type */ |
| if ((parse_bm & CPH_APP_PARSE_FIELD_ICMPV6_TYPE) && |
| (parse_key->icmpv6_type != MV_ICMPV6_TYPE_MLD)) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "parse_bm[0x%x], icmpv6_type[%d], currently only support ICMPv6 MLD type[%d]\n", |
| parse_bm, parse_key->icmpv6_type, MV_ICMPV6_TYPE_MLD); |
| return MV_BAD_VALUE; |
| } |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_validate_mod_field() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Validate the modification filed of CPH rule |
| * |
| * INPUTS: |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_validate_mod_field ( |
| CPH_APP_MOD_FIELD_E mod_bm, |
| CPH_APP_MOD_T *mod_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| /* Check the range of mod_bm */ |
| if (mod_bm >= CPH_APP_MOD_FIELD_END) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "mod_bm[0x%x] is out of range[0x01~0x%x] \n", mod_bm, CPH_APP_MOD_FIELD_END); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| /* Does not support adding GMAC information and strip MH at the same time */ |
| if ((mod_bm & CPH_APP_RX_MOD_ADD_GMAC) && |
| (mod_bm & CPH_APP_RX_MOD_STRIP_MH)) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "mod_bm[0x%x], does not support adding GMAC information and stripping MH at the same time \n", mod_bm); |
| return MV_BAD_VALUE; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_validate_frwd_field() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Validate the forwarding filed of CPH rule |
| * |
| * INPUTS: |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_validate_frwd_field ( |
| CPH_APP_FRWD_FIELD_E frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| /* Check the range of frwd_bm */ |
| if (frwd_bm >= CPH_APP_FRWD_FIELD_END) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "frwd_bm[0x%x] is out of range[0x01~0x%x] \n", frwd_bm, CPH_APP_FRWD_FIELD_END); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_add_rule() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Add CPH rule |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_add_rule ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key, |
| CPH_APP_MOD_FIELD_E mod_bm, |
| CPH_APP_MOD_T *mod_value, |
| CPH_APP_FRWD_FIELD_E frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_app_validate_parse_field(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid parsing field"); |
| |
| rc = cph_app_validate_mod_field(mod_bm, mod_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid modification field"); |
| |
| rc = cph_app_validate_frwd_field(frwd_bm, frwd_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid forwarding field"); |
| |
| rc = cph_db_add_app_rule(parse_bm, parse_key, mod_bm, mod_value, frwd_bm, frwd_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_add_app_rule"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_del_rule() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Delete CPH rule |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_del_rule ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_app_validate_parse_field(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid parsing field"); |
| |
| rc = cph_db_del_app_rule(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_del_app_rule"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_update_rule() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Update CPH rule |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_update_rule ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key, |
| CPH_APP_MOD_FIELD_E mod_bm, |
| CPH_APP_MOD_T *mod_value, |
| CPH_APP_FRWD_FIELD_E frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_app_validate_parse_field(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid parsing field"); |
| |
| rc = cph_app_validate_mod_field(mod_bm, mod_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid modification field"); |
| |
| rc = cph_app_validate_frwd_field(frwd_bm, frwd_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid forwarding field"); |
| |
| rc = cph_db_update_app_rule(parse_bm, parse_key, mod_bm, mod_value, frwd_bm, frwd_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_update_app_rule"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_get_rule() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Get CPH rule |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * |
| * OUTPUTS: |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_get_rule ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key, |
| CPH_APP_MOD_FIELD_E *mod_bm, |
| CPH_APP_MOD_T *mod_value, |
| CPH_APP_FRWD_FIELD_E *frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_app_validate_parse_field(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid parsing field"); |
| |
| rc = cph_db_get_app_rule(parse_bm, parse_key, mod_bm, mod_value, frwd_bm, frwd_value); |
| if (rc != MV_OK) |
| MV_CPH_PRINT(CPH_DEBUG_LEVEL, "fail to call cph_app_get_rule\n"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_get_rule_by_dir_proto() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Get CPH rule according to protocol type |
| * |
| * INPUTS: |
| * dir - Direction |
| * proto_type - SKB protocol type |
| * |
| * OUTPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_get_rule_by_dir_proto ( |
| CPH_DIR_E dir, |
| UINT16 proto_type, |
| CPH_APP_PARSE_FIELD_E *parse_bm, |
| CPH_APP_PARSE_T *parse_key, |
| CPH_APP_MOD_FIELD_E *mod_bm, |
| CPH_APP_MOD_T *mod_value, |
| CPH_APP_FRWD_FIELD_E *frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_db_get_app_rule_by_dir_proto(dir, proto_type, parse_bm, parse_key, mod_bm, mod_value, frwd_bm, frwd_value); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_get_app_rule_by_dir_proto"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_increase_counter() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Increase RX counter |
| * |
| * INPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_increase_counter ( |
| CPH_APP_PARSE_FIELD_E parse_bm, |
| CPH_APP_PARSE_T *parse_key) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_app_validate_parse_field(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to valid parsing field"); |
| |
| rc = cph_db_increase_counter(parse_bm, parse_key); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_increase_counter"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_increase_counter_by_dir_proto() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Increase RX counter according to protocol type |
| * |
| * INPUTS: |
| * dir - Direction |
| * proto_type - SKB protocol type |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_increase_counter_by_dir_proto ( |
| CPH_DIR_E dir, |
| UINT16 proto_type) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| rc = cph_db_increase_counter_by_dir_proto(dir, proto_type); |
| CHECK_API_RETURN_AND_LOG_ERROR(rc, "fail to call cph_db_increase_counter_by_dir_proto"); |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_parse_ge_port_type() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Get GEMAC port type by profile ID |
| * |
| * INPUTS: |
| * None. |
| * |
| * OUTPUTS: |
| * port_type - Modification bitmap |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_parse_ge_port_type ( |
| CPH_PORT_STATE_T *port_type) |
| { |
| tpm_eth_complex_profile_t profile_id = 0; |
| MV_APP_GMAC_PORT_E active_port = 0; |
| MV_STATUS rc = MV_OK; |
| |
| /* Get Profile ID and active WAN port */ |
| cph_db_get_param(CPH_DB_PARAM_PROFILE_ID, &profile_id); |
| cph_db_get_param(CPH_DB_PARAM_ACTIVE_PORT, &active_port); |
| |
| switch (profile_id) |
| { |
| case TPM_PON_WAN_DUAL_MAC_INT_SWITCH: |
| case TPM_PON_WAN_G1_LAN_G0_INT_SWITCH: |
| case TPM_PON_WAN_DUAL_MAC_EXT_SWITCH: |
| case TPM_PON_WAN_G0_G1_DUAL_LAN: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_ACTIVE; |
| break; |
| case TPM_PON_WAN_G0_INT_SWITCH: |
| case TPM_PON_WAN_G0_SINGLE_PORT: |
| case TPM_PON_WAN_G0_SINGLE_PORT_SGMII: |
| case TPM_PON_WAN_G0_G1_LPBK: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_INVALID; |
| port_type[MV_APP_PON_MAC_PORT].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_ACTIVE; |
| break; |
| case TPM_G0_WAN_G1_INT_SWITCH: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_INVALID; |
| break; |
| case TPM_G1_WAN_G0_INT_SWITCH: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_INVALID; |
| break; |
| case TPM_PON_G1_WAN_G0_INT_SWITCH: |
| case TPM_PON_G1_WAN_G0_SINGLE_PORT: |
| case TPM_PON_G1_SGMII_WAN_G0_SINGLE_PORT: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_PON_MAC_PORT].port_type = MV_APP_PORT_WAN; |
| |
| if (active_port == MV_APP_GMAC_PORT_1) { |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_INACTIVE; |
| } |
| else { |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_INACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_ACTIVE; |
| } |
| break; |
| case TPM_PON_G0_WAN_G1_INT_SWITCH: |
| case TPM_PON_G0_WAN_G1_SINGLE_PORT: |
| port_type[MV_APP_GMAC_PORT_0].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_type = MV_APP_PORT_WAN; |
| |
| if (active_port == MV_APP_GMAC_PORT_0) { |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_INACTIVE; |
| } |
| else { |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_INACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_ACTIVE; |
| } |
| break; |
| case TPM_PON_WAN_G1_MNG_EXT_SWITCH: |
| case TPM_PON_WAN_G1_SINGLE_PORT: |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_INVALID; |
| port_type[MV_APP_GMAC_PORT_1].port_type = MV_APP_PORT_LAN; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_ACTIVE; |
| port_type[MV_APP_PON_MAC_PORT].port_type = MV_APP_PORT_WAN; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_ACTIVE; |
| break; |
| default: |
| port_type[MV_APP_GMAC_PORT_0].port_state = MV_GE_PORT_INVALID; |
| port_type[MV_APP_GMAC_PORT_1].port_state = MV_GE_PORT_INVALID; |
| port_type[MV_APP_PON_MAC_PORT].port_state = MV_GE_PORT_INVALID; |
| break; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_parse_peer_port() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Get peer GEMAC port |
| * |
| * INPUTS: |
| * port - Original port |
| * |
| * OUTPUTS: |
| * peer_port - Peer port |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_parse_peer_port ( |
| INT32 port, |
| INT32 *peer_port) |
| { |
| UINT32 idx = 0; |
| CPH_PORT_STATE_T port_type[MV_APP_GMAC_PORT_NUM]; |
| MV_STATUS rc = MV_FAIL; |
| |
| /* Verify port */ |
| if (port > MV_APP_PON_MAC_PORT ) { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "port[%d] is out of range[0~%d] \n", port, MV_APP_PON_MAC_PORT); |
| return MV_OUT_OF_RANGE; |
| } |
| |
| /* Get port type */ |
| rc = cph_app_parse_ge_port_type(&port_type[0]); |
| |
| /* Search for peer port */ |
| if (port_type[port].port_type == MV_APP_PORT_LAN) |
| { |
| for (idx = 0; idx < MV_APP_GMAC_PORT_NUM; idx++) |
| { |
| if (idx == port) |
| continue; |
| if ((port_type[idx].port_type == MV_APP_PORT_WAN) && |
| (port_type[idx].port_state == MV_GE_PORT_ACTIVE)) |
| { |
| *peer_port = idx; |
| rc = MV_OK; |
| break; |
| } |
| } |
| } |
| else if (port_type[port].port_type == MV_APP_PORT_WAN) |
| { |
| for (idx = 0; idx < MV_APP_GMAC_PORT_NUM; idx++) |
| { |
| if (idx == port) |
| continue; |
| if (port_type[idx].port_type == MV_APP_PORT_LAN) |
| { |
| *peer_port = idx; |
| rc = MV_OK; |
| break; |
| } |
| } |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_parse_dir() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Parse application packet to output parse bitmap and value |
| * |
| * INPUTS: |
| * port - GE MAC port |
| * rx - Whether RX path |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * Return direction. |
| *******************************************************************************/ |
| CPH_DIR_E cph_app_parse_dir ( |
| INT32 port, |
| BOOL rx) |
| { |
| CPH_PORT_STATE_T port_type[MV_APP_GMAC_PORT_NUM]; |
| MV_STATUS rc = MV_OK; |
| CPH_DIR_E dir = CPH_DIR_INVALID; |
| |
| /* Parse port */ |
| if (port > MV_APP_PON_MAC_PORT ) { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "port[%d] is out of range[0~%d] \n", port, MV_APP_PON_MAC_PORT); |
| return dir; |
| } |
| |
| /* Get GMAC WAN/LAN type */ |
| rc = cph_app_parse_ge_port_type(&port_type[0]); |
| if (rc != MV_OK) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "fail to call cph_app_parse_ge_port_type() \n"); |
| return dir; |
| } |
| |
| /* Rx dir */ |
| if (rx == TRUE) |
| { |
| if ((port_type[port].port_type == MV_APP_PORT_WAN) && |
| (port_type[port].port_state == MV_GE_PORT_ACTIVE)) |
| dir = CPH_DIR_DS; |
| else if ((port_type[port].port_type == MV_APP_PORT_LAN) && |
| (port_type[port].port_state == MV_GE_PORT_ACTIVE)) |
| dir = CPH_DIR_US; |
| else |
| { |
| dir = CPH_DIR_INVALID; |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "dir[%d] is invalid \n", dir); |
| } |
| } |
| /* Tx dir */ |
| else |
| { |
| if ((port_type[port].port_type == MV_APP_PORT_WAN) && |
| (port_type[port].port_state == MV_GE_PORT_ACTIVE)) |
| dir = CPH_DIR_US; |
| else if ((port_type[port].port_type == MV_APP_PORT_LAN) && |
| (port_type[port].port_state == MV_GE_PORT_ACTIVE)) |
| dir = CPH_DIR_DS; |
| else |
| { |
| dir = CPH_DIR_INVALID; |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "dir[%d] is invalid \n", dir); |
| } |
| } |
| |
| return dir; |
| } |
| |
| /****************************************************************************** |
| * cph_app_parse_packet() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Parse application packet to output parse bitmap and value |
| * |
| * INPUTS: |
| * port - GE MAC port |
| * skb_data - Pointer to SKB data holding application packet |
| * |
| * OUTPUTS: |
| * parse_bm - Parsing bitmap |
| * parse_key - Parsing key |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_parse_packet ( |
| INT32 port, |
| UINT8 *skb_data, |
| CPH_APP_PARSE_FIELD_E *parse_bm, |
| CPH_APP_PARSE_T *parse_key) |
| { |
| UINT16 eth_type = 0; |
| struct ipv6hdr *p_ipv6_hdr = NULL; |
| struct ipv6_hopopt_hdr *p_hopopt_hdr = NULL; |
| struct icmp6hdr *p_icmp_hdr = NULL; |
| UINT8 *p_field = NULL; |
| MV_STATUS rc = MV_OK; |
| |
| *parse_bm = 0; |
| memset(parse_key, 0, sizeof(CPH_APP_PARSE_T)); |
| |
| /* Parse dir */ |
| parse_key->dir = cph_app_parse_dir(port, TRUE); |
| if(parse_key->dir == CPH_DIR_INVALID) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "dir[%d] is invalid \n", parse_key->dir); |
| return MV_BAD_VALUE; |
| } |
| *parse_bm |= CPH_APP_PARSE_FIELD_DIR; |
| |
| /* Parse RX/TX */ |
| parse_key->rx_tx = CPH_DIR_RX; |
| *parse_bm |= CPH_APP_PARSE_FIELD_RX_TX; |
| |
| /* Parse Marvell header */ |
| if (parse_key->dir == CPH_DIR_US) |
| parse_key->mh = (ntohs(*(UINT16 *)skb_data) & MV_VALID_MH_MASK); |
| else |
| parse_key->mh = (ntohs(*(UINT16 *)skb_data) & MV_VALID_GH_MASK); |
| *parse_bm |= CPH_APP_PARSE_FIELD_MH; |
| |
| /* Parse Eth type */ |
| p_field = skb_data + MV_ETH_MH_SIZE + ETH_ALEN + ETH_ALEN; |
| eth_type = ntohs(*(UINT16 *)p_field); |
| while (eth_type == MV_TPID_8100 || eth_type == MV_TPID_88A8 || eth_type == MV_TPID_9100) { |
| p_field += VLAN_HLEN; |
| eth_type = ntohs(*(UINT16 *)p_field); |
| } |
| parse_key->eth_type = eth_type; |
| *parse_bm |= CPH_APP_PARSE_FIELD_ETH_TYPE; |
| |
| /* Parse IPv4 type */ |
| if (eth_type == ETH_P_IP) { |
| p_field += MV_CPH_ETH_TYPE_LEN; |
| p_field += MV_IPV4_PROTO_OFFSET; |
| parse_key->ipv4_type = *(UINT8 *)p_field; |
| *parse_bm |= CPH_APP_PARSE_FIELD_IPV4_TYPE; |
| } |
| /* Parse IPv6 type */ |
| else if (eth_type == ETH_P_IPV6) { |
| |
| p_ipv6_hdr = (struct ipv6hdr *)(p_field + MV_CPH_ETH_TYPE_LEN); |
| parse_key->ipv6_nh1 = p_ipv6_hdr->nexthdr; |
| *parse_bm |= CPH_APP_PARSE_FIELD_IPV6_NH1; |
| |
| if (p_ipv6_hdr->nexthdr != NEXTHDR_HOP) |
| return rc; |
| |
| p_hopopt_hdr = (struct ipv6_hopopt_hdr *)((UINT8 *)p_ipv6_hdr + sizeof(struct ipv6hdr)); |
| |
| parse_key->ipv6_nh2 = p_hopopt_hdr->nexthdr; |
| *parse_bm |= CPH_APP_PARSE_FIELD_IPV6_NH2; |
| |
| if (p_hopopt_hdr->nexthdr != IPPROTO_ICMPV6) |
| return rc; |
| |
| p_icmp_hdr = (struct icmp6hdr *)((UINT8 *)p_hopopt_hdr + ipv6_optlen(p_hopopt_hdr)); |
| |
| switch (p_icmp_hdr->icmp6_type) { |
| case ICMPV6_MGM_QUERY: |
| case ICMPV6_MGM_REPORT: |
| case ICMPV6_MGM_REDUCTION: |
| case ICMPV6_MLD2_REPORT: |
| parse_key->icmpv6_type = MV_ICMPV6_TYPE_MLD; |
| *parse_bm |= CPH_APP_PARSE_FIELD_ICMPV6_TYPE; |
| break; |
| default: |
| break; |
| } |
| |
| } |
| /* Parse Ethenet subtype */ |
| else { |
| parse_key->eth_subtype = (*(UINT8 *)(p_field + MV_CPH_ETH_TYPE_LEN)); |
| *parse_bm |= CPH_APP_PARSE_FIELD_ETH_SUBTYPE; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_mod_rx_packet() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Modify RX application packet |
| * |
| * INPUTS: |
| * port - Gmac port the packet from |
| * dev - Net device |
| * skb - SKB buffer to receive packet |
| * rx_desc - RX descriptor |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_mod_rx_packet ( |
| INT32 port, |
| struct net_device *dev, |
| struct sk_buff *skb, |
| struct neta_rx_desc *rx_desc, |
| CPH_APP_MOD_FIELD_E mod_bm, |
| CPH_APP_MOD_T *mod_value) |
| { |
| UINT8 *p_data = NULL; |
| MV_STATUS rc = MV_OK; |
| |
| /* Save GMAC Information */ |
| if (mod_bm & CPH_APP_RX_MOD_ADD_GMAC) |
| { |
| p_data = (UINT8 *)skb->data; |
| p_data[0] &= 0x0F; |
| p_data[0] |= ((port & 0x0F) << 4); |
| } |
| |
| /* Replace protocol type */ |
| skb->tail += rx_desc->dataSize; |
| skb->len = rx_desc->dataSize; |
| |
| if (mod_bm & CPH_APP_RX_MOD_STRIP_MH) |
| { |
| |
| skb->data += MV_ETH_MH_SIZE; |
| skb->tail -= MV_ETH_MH_SIZE; |
| skb->len -= MV_ETH_MH_SIZE; |
| } |
| |
| skb->protocol = eth_type_trans(skb, dev); |
| if (mod_bm & CPH_APP_RX_MOD_REPLACE_PROTO_TYPE) |
| { |
| skb->protocol = mod_value->proto_type; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_mod_tx_packet() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Modify TX application packet |
| * |
| * INPUTS: |
| * skb - Pointer to SKB data hoding application packet |
| * tx_spec_out - TX descriptor |
| * mod_bm - Modification bitmap |
| * mod_value - Modification value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_mod_tx_packet ( |
| struct sk_buff *skb, |
| struct mv_eth_tx_spec *tx_spec_out, |
| CPH_APP_MOD_FIELD_E mod_bm, |
| CPH_APP_MOD_T *mod_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| if (mod_bm & CPH_APP_TX_MOD_ADD_MH_BY_DRIVER) |
| { |
| tx_spec_out->flags |= MV_ETH_F_MH; |
| } |
| |
| if (mod_bm & CPH_APP_TX_MOD_NO_PAD) |
| { |
| tx_spec_out->flags |= MV_ETH_F_NO_PAD; |
| } |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_set_frwd() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Set packet forwarding information |
| * |
| * INPUTS: |
| * skb - Pointer to SKB data hoding application packet |
| * tx_spec_out - TX descriptor |
| * frwd_bm - Forwarding bitmap |
| * frwd_value - Forwarding value |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_app_set_frwd ( |
| struct sk_buff *skb, |
| struct mv_eth_tx_spec *tx_spec_out, |
| CPH_APP_FRWD_FIELD_E frwd_bm, |
| CPH_APP_FRWD_T *frwd_value) |
| { |
| MV_STATUS rc = MV_OK; |
| |
| if (frwd_bm & CPH_APP_FRWD_SET_TRG_PORT) |
| { |
| tx_spec_out->txp = frwd_value->trg_port; |
| } |
| |
| if (frwd_bm & CPH_APP_FRWD_SET_TRG_QUEUE) |
| { |
| tx_spec_out->txq = frwd_value->trg_queue; |
| } |
| |
| if (frwd_bm & CPH_APP_FRWD_SET_GEM_PORT) |
| { |
| tx_spec_out->hw_cmd = ((frwd_value->gem_port << 8)|0x0010); |
| } |
| |
| tx_spec_out->tx_func = NULL; |
| |
| return rc; |
| } |
| |
| /****************************************************************************** |
| * cph_app_rx_bc() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: CPH function to handle the received broadcast packets |
| * |
| * INPUTS: |
| * port - Gmac port the packet from |
| * dev - Net device |
| * pkt - Marvell packet information |
| * rx_desc - RX descriptor |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns 1. |
| * On error returns 0. |
| *******************************************************************************/ |
| INT32 cph_app_rx_bc(INT32 port, struct net_device *dev, struct eth_pbuf *pkt, struct neta_rx_desc *rx_desc) |
| { |
| CPH_FLOW_ENTRY_T flow_rule; |
| INT32 peer_port = 0; |
| INT32 rx_size = 0; |
| INT32 offset = 0; |
| BOOL state = FALSE; |
| struct sk_buff *skb_old = NULL; |
| struct sk_buff *skb_new = NULL; |
| tpm_eth_complex_profile_t profile_id = 0; |
| MV_APP_GMAC_PORT_E active_port = 0; |
| MV_STATUS rc = MV_OK; |
| |
| /* Check whether need to handle broadcast packet */ |
| cph_db_get_param(CPH_DB_PARAM_BC_SUPPORT, &state); |
| if (state == FALSE) |
| return 0; |
| |
| /* Parse packets */ |
| skb_old = (struct sk_buff *)(pkt->osInfo); |
| skb_new = (struct sk_buff *)(pkt->osInfo); |
| rc = cph_flow_parse_packet(port, skb_old->data, TRUE, TRUE, &flow_rule); |
| if (rc != MV_OK) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "fail to call cph_flow_parse_packet, rc<%d> \n", rc); |
| return 0; |
| } |
| |
| /* U/S */ |
| if(flow_rule.dir == CPH_DIR_US) |
| { |
| /* Forward packet to peer port */ |
| rc = cph_app_parse_peer_port(port, &peer_port); |
| if (rc != MV_OK) |
| { |
| MV_CPH_PRINT(CPH_ERR_LEVEL, "fail to call cph_app_parse_peer_port, rc<%d> \n", rc); |
| return 0; |
| } |
| |
| MV_CPH_PRINT(CPH_DEBUG_LEVEL, "peer_port=%d\n", peer_port); |
| |
| /* Forward packet */ |
| if (netif_running(mv_net_devs[peer_port])) { |
| /* Copy a new SKB */ |
| skb_old->tail += rx_desc->dataSize; |
| skb_old->len = rx_desc->dataSize; |
| skb_new = skb_copy(skb_old, GFP_ATOMIC); |
| if(skb_new == NULL) |
| { |
| skb_new = skb_old; |
| goto out; |
| } |
| // Remove CRC from original message. It is not needed when forwarding to WAN interface |
| skb_old->tail -= MV_ETH_CRC_SIZE; // Remove CRC |
| skb_old->len -= MV_ETH_CRC_SIZE; // Remove CRC |
| |
| /* If WAN interface is GMAC1, remove MH in upstream */ |
| cph_db_get_param(CPH_DB_PARAM_PROFILE_ID, &profile_id); |
| cph_db_get_param(CPH_DB_PARAM_ACTIVE_PORT, &active_port); |
| if ((profile_id == TPM_PON_G1_SGMII_WAN_G0_SINGLE_PORT) && (active_port == MV_APP_GMAC_PORT_1)) |
| { |
| skb_old->data += MV_ETH_MH_SIZE; |
| skb_old->tail -= MV_ETH_MH_SIZE; |
| skb_old->len -= MV_ETH_MH_SIZE; |
| } |
| |
| mv_net_devs[peer_port]->netdev_ops->ndo_start_xmit(skb_old, mv_net_devs[peer_port]); |
| } |
| } |
| out: |
| /* Stripe VLAN tag, then send to Linux network stack */ |
| offset = cph_flow_strip_vlan(TRUE, skb_new->data); |
| skb_new->data += offset; |
| rx_size -= offset; |
| |
| /* Strip MH */ |
| skb_new->data += MV_ETH_MH_SIZE; |
| offset += MV_ETH_MH_SIZE; |
| |
| skb_new->tail -= offset; |
| skb_new->len -= offset; |
| skb_new->protocol = eth_type_trans(skb_new, dev); |
| |
| cph_rec_skb(port, skb_new); |
| |
| return 1; |
| } |
| |
| /****************************************************************************** |
| * cph_app_lookup_profile_id() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:lookup profile ID string according to value |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * Enum string |
| *******************************************************************************/ |
| CHAR *cph_app_lookup_profile_id(INT32 enum_value) |
| { |
| return mtype_lookup_enum_str(&g_enum_array_profile_id, enum_value); |
| } |
| |
| /****************************************************************************** |
| * cph_app_lookup_pon_type() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:lookup PON type string according to value |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * Enum string |
| *******************************************************************************/ |
| CHAR *cph_app_lookup_pon_type(INT32 enum_value) |
| { |
| return mtype_lookup_enum_str(&g_enum_array_pon_type, enum_value); |
| } |
| |
| /****************************************************************************** |
| * cph_app_lookup_dir() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:lookup direction string according to value |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * Enum string |
| *******************************************************************************/ |
| CHAR *cph_app_lookup_dir(INT32 enum_value) |
| { |
| return mtype_lookup_enum_str(&g_enum_array_dir, enum_value); |
| } |
| |
| /****************************************************************************** |
| * cph_app_lookup_rx_tx() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:lookup RX/TX direction string according to value |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * Enum string |
| *******************************************************************************/ |
| CHAR *cph_app_lookup_rx_tx(INT32 enum_value) |
| { |
| return mtype_lookup_enum_str(&g_enum_array_rx_tx, enum_value); |
| } |
| |
| /****************************************************************************** |
| * cph_app_lookup_gmac() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:lookup GMAC string according to value |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * Enum string |
| *******************************************************************************/ |
| CHAR *cph_app_lookup_gmac(INT32 enum_value) |
| { |
| return mtype_lookup_enum_str(&g_enum_array_gmac, enum_value); |
| } |
| |
| |
| /****************************************************************************** |
| * cph_app_init() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION: Initializes CPH application module. |
| * |
| * INPUTS: |
| * None. |
| * |
| * OUTPUTS: |
| * None. |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| INT32 cph_app_init(VOID) |
| { |
| |
| cph_db_init(); |
| |
| return MV_OK; |
| } |
| |
| /****************************************************************************** |
| * cph_set_trace_flag() |
| * _____________________________________________________________________________ |
| * |
| * DESCRIPTION:sets cph trace flag. |
| * |
| * INPUTS: |
| * enum_value - The enum value to be matched |
| * |
| * OUTPUTS: |
| * None |
| * |
| * RETURNS: |
| * On success, the function returns MV_OK. |
| * On error returns error code accordingly. |
| *******************************************************************************/ |
| MV_STATUS cph_set_trace_flag(UINT32 flag) |
| { |
| g_cph_global_trace = flag; |
| |
| return MV_OK; |
| } |
