| /* |
| * Copyright (c) 2012, 2016-2017, The Linux Foundation. All rights reserved. |
| * Permission to use, copy, modify, and/or distribute this software for |
| * any purpose with or without fee is hereby granted, provided that the |
| * above copyright notice and this permission notice appear in all copies. |
| * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT |
| * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| */ |
| |
| |
| /** |
| * @defgroup shiva_init SHIVA_INIT |
| * @{ |
| */ |
| #include "sw.h" |
| #include "hsl.h" |
| #include "hsl_dev.h" |
| #include "hsl_port_prop.h" |
| #include "shiva_mib.h" |
| #include "shiva_port_ctrl.h" |
| #include "shiva_portvlan.h" |
| #include "shiva_vlan.h" |
| #include "shiva_fdb.h" |
| #include "shiva_qos.h" |
| #include "shiva_mirror.h" |
| #include "shiva_stp.h" |
| #include "shiva_rate.h" |
| #include "shiva_misc.h" |
| #include "shiva_leaky.h" |
| #include "shiva_igmp.h" |
| #include "shiva_acl.h" |
| #include "shiva_led.h" |
| #include "shiva_reg_access.h" |
| #include "shiva_reg.h" |
| #include "shiva_init.h" |
| #include "f1_phy.h" |
| |
| static ssdk_init_cfg * shiva_cfg[SW_MAX_NR_DEV] = { 0 }; |
| |
| #if !(defined(KERNEL_MODULE) && defined(USER_MODE)) |
| /* For SHIVA there are five internal PHY devices and seven MAC devices. |
| MAC0 always connect to external MAC device. |
| PHY4 can connect to MAC5 or external MAC device. |
| MAC6 always connect to external devices. |
| MAC1..MAC4 connect to internal PHY0..PHY3. |
| */ |
| static sw_error_t |
| shiva_portproperty_init(a_uint32_t dev_id, hsl_init_mode mode) |
| { |
| hsl_port_prop_t p_type; |
| hsl_dev_t *pdev = NULL; |
| fal_port_t port_id; |
| |
| pdev = hsl_dev_ptr_get(dev_id); |
| if (pdev == NULL) |
| return SW_NOT_INITIALIZED; |
| |
| for (port_id = 0; port_id < pdev->nr_ports; port_id++) |
| { |
| hsl_port_prop_portmap_set(dev_id, port_id); |
| |
| for (p_type = HSL_PP_PHY; p_type < HSL_PP_BUTT; p_type++) |
| { |
| if (HSL_NO_CPU == mode) |
| { |
| SW_RTN_ON_ERROR(hsl_port_prop_set(dev_id, port_id, p_type)); |
| continue; |
| } |
| |
| switch (p_type) |
| { |
| case HSL_PP_PHY: |
| if (HSL_CPU_1 != mode) |
| { |
| if ((port_id != pdev->cpu_port_nr) |
| && (port_id != (pdev->nr_ports -1)) |
| && (port_id != (pdev->nr_ports -2))) |
| { |
| SW_RTN_ON_ERROR(hsl_port_prop_set(dev_id, port_id, p_type)); |
| } |
| } |
| else |
| { |
| if ((port_id != pdev->cpu_port_nr) |
| && (port_id != pdev->nr_ports - 1)) |
| { |
| SW_RTN_ON_ERROR(hsl_port_prop_set(dev_id, port_id, p_type)); |
| } |
| } |
| break; |
| |
| case HSL_PP_INCL_CPU: |
| /* include cpu port but exclude wan port in some cases */ |
| if (!((HSL_CPU_2 == mode) && (port_id == (pdev->nr_ports - 2)))) |
| SW_RTN_ON_ERROR(hsl_port_prop_set(dev_id, port_id, p_type)); |
| |
| break; |
| |
| case HSL_PP_EXCL_CPU: |
| /* exclude cpu port and wan port in some cases */ |
| if ((port_id != pdev->cpu_port_nr) |
| && (!((HSL_CPU_2 == mode) && (port_id == (pdev->nr_ports - 2))))) |
| SW_RTN_ON_ERROR(hsl_port_prop_set(dev_id, port_id, p_type)); |
| break; |
| |
| default: |
| break; |
| } |
| } |
| |
| if (HSL_NO_CPU == mode) |
| { |
| SW_RTN_ON_ERROR(hsl_port_prop_set_phyid |
| (dev_id, port_id, port_id + 1)); |
| } |
| else |
| { |
| if (port_id != pdev->cpu_port_nr) |
| { |
| SW_RTN_ON_ERROR(hsl_port_prop_set_phyid |
| (dev_id, port_id, port_id - 1)); |
| } |
| } |
| } |
| |
| return SW_OK; |
| } |
| |
| static sw_error_t |
| shiva_hw_init(a_uint32_t dev_id, ssdk_init_cfg *cfg) |
| { |
| hsl_dev_t *pdev = NULL; |
| a_uint32_t port_id; |
| a_uint32_t data = 0; |
| sw_error_t rv; |
| |
| pdev = hsl_dev_ptr_get(dev_id); |
| if (NULL == pdev) |
| { |
| return SW_NOT_INITIALIZED; |
| } |
| |
| for (port_id = 0; port_id < pdev->nr_ports; port_id++) |
| { |
| if (port_id == pdev->cpu_port_nr) |
| { |
| continue; |
| } |
| |
| HSL_REG_ENTRY_GET(rv, dev_id, PORT_STATUS, port_id, |
| (a_uint8_t *) (&data), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| SW_SET_REG_BY_FIELD(PORT_STATUS, LINK_EN, 1, data); |
| |
| HSL_REG_ENTRY_SET(rv, dev_id, PORT_STATUS, port_id, |
| (a_uint8_t *) (&data), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| } |
| |
| return SW_OK; |
| } |
| |
| #if 0 |
| static sw_error_t |
| shiva_bist_test(a_uint32_t dev_id) |
| { |
| a_uint32_t entry = 0, data, i; |
| sw_error_t rv; |
| |
| data = 1; |
| i = 0x1000; |
| while (data && --i) |
| { |
| HSL_REG_ENTRY_GET(rv, dev_id, BIST_CTRL, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| SW_GET_FIELD_BY_REG(BIST_CTRL, BIST_BUSY, data, entry); |
| aos_udelay(5); |
| } |
| |
| if (0 == i) |
| { |
| return SW_INIT_ERROR; |
| } |
| |
| entry = 0; |
| SW_SET_REG_BY_FIELD(BIST_CTRL, BIST_BUSY, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN2, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN1, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN0, 1, entry); |
| |
| HSL_REG_ENTRY_SET(rv, dev_id, BIST_CTRL, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| data = 1; |
| i = 0x1000; |
| while (data && --i) |
| { |
| HSL_REG_ENTRY_GET(rv, dev_id, BIST_CTRL, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| SW_GET_FIELD_BY_REG(BIST_CTRL, BIST_BUSY, data, entry); |
| aos_udelay(5); |
| } |
| |
| if (0 == i) |
| { |
| return SW_INIT_ERROR; |
| } |
| |
| SW_GET_FIELD_BY_REG(BIST_CTRL, ERR_CNT, data, entry); |
| if (data) |
| { |
| SW_GET_FIELD_BY_REG(BIST_CTRL, ONE_ERR, data, entry); |
| if (!data) |
| { |
| return SW_INIT_ERROR; |
| } |
| |
| SW_GET_FIELD_BY_REG(BIST_CTRL, ERR_ADDR, data, entry); |
| |
| entry = 0; |
| SW_SET_REG_BY_FIELD(BIST_RCV, RCV_EN, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_RCV, RCV_ADDR, data, entry); |
| HSL_REG_ENTRY_SET(rv, dev_id, BIST_RCV, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| } |
| else |
| { |
| return SW_OK; |
| } |
| |
| entry = 0; |
| SW_SET_REG_BY_FIELD(BIST_CTRL, BIST_BUSY, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN2, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN1, 1, entry); |
| SW_SET_REG_BY_FIELD(BIST_CTRL, PTN_EN0, 1, entry); |
| |
| HSL_REG_ENTRY_SET(rv, dev_id, BIST_CTRL, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| data = 1; |
| i = 0x1000; |
| while (data && --i) |
| { |
| HSL_REG_ENTRY_GET(rv, dev_id, BIST_CTRL, 0, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| SW_GET_FIELD_BY_REG(BIST_CTRL, BIST_BUSY, data, entry); |
| aos_udelay(5); |
| } |
| |
| if (0 == i) |
| { |
| return SW_INIT_ERROR; |
| } |
| |
| SW_GET_FIELD_BY_REG(BIST_CTRL, ERR_CNT, data, entry); |
| if (data) |
| { |
| return SW_INIT_ERROR; |
| } |
| |
| return SW_OK; |
| } |
| #endif |
| #endif |
| |
| static sw_error_t |
| shiva_dev_init(a_uint32_t dev_id, hsl_init_mode cpu_mode) |
| { |
| hsl_dev_t *pdev = NULL; |
| |
| pdev = hsl_dev_ptr_get(dev_id); |
| if (pdev == NULL) |
| return SW_NOT_INITIALIZED; |
| |
| pdev->nr_ports = 7; |
| pdev->nr_phy = 5; |
| pdev->cpu_port_nr = 0; |
| pdev->nr_vlans = 4096; |
| pdev->hw_vlan_query = A_TRUE; |
| pdev->nr_queue = 4; |
| pdev->cpu_mode = cpu_mode; |
| |
| return SW_OK; |
| } |
| |
| |
| static sw_error_t |
| _shiva_reset(a_uint32_t dev_id) |
| { |
| #if !(defined(KERNEL_MODULE) && defined(USER_MODE)) |
| sw_error_t rv; |
| a_uint32_t val; |
| |
| HSL_DEV_ID_CHECK(dev_id); |
| |
| val = 0x1; |
| HSL_REG_FIELD_SET(rv, dev_id, MASK_CTL, 0, SOFT_RST, |
| (a_uint8_t *) (&val), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| rv = shiva_hw_init(dev_id, shiva_cfg[dev_id]); |
| SW_RTN_ON_ERROR(rv); |
| |
| SHIVA_ACL_RESET(rv, dev_id); |
| #endif |
| |
| return SW_OK; |
| } |
| |
| sw_error_t |
| shiva_cleanup(a_uint32_t dev_id) |
| { |
| if (shiva_cfg[dev_id]) |
| { |
| aos_mem_free(shiva_cfg[dev_id]); |
| shiva_cfg[dev_id] = NULL; |
| } |
| |
| return SW_OK; |
| } |
| |
| /** |
| * @brief reset hsl layer. |
| * @details Comments: |
| * This operation will reset hsl layer |
| * @param[in] dev_id device id |
| * @return SW_OK or error code |
| */ |
| HSL_LOCAL sw_error_t |
| shiva_reset(a_uint32_t dev_id) |
| { |
| sw_error_t rv; |
| |
| HSL_API_LOCK; |
| rv = _shiva_reset(dev_id); |
| HSL_API_UNLOCK; |
| return rv; |
| } |
| |
| /** |
| * @brief Init hsl layer. |
| * @details Comments: |
| * This operation will init hsl layer and hsl layer |
| * @param[in] dev_id device id |
| * @param[in] cfg configuration for initialization |
| * @return SW_OK or error code |
| */ |
| sw_error_t |
| shiva_init(a_uint32_t dev_id, ssdk_init_cfg *cfg) |
| { |
| sw_error_t rv; |
| HSL_DEV_ID_CHECK(dev_id); |
| |
| if (NULL == shiva_cfg[dev_id]) |
| { |
| shiva_cfg[dev_id] = aos_mem_alloc(sizeof (ssdk_init_cfg)); |
| } |
| |
| if (NULL == shiva_cfg[dev_id]) |
| { |
| return SW_OUT_OF_MEM; |
| } |
| |
| aos_mem_copy(shiva_cfg[dev_id], cfg, sizeof (ssdk_init_cfg)); |
| |
| SW_RTN_ON_ERROR(shiva_reg_access_init(dev_id, cfg->reg_mode)); |
| |
| SW_RTN_ON_ERROR(shiva_dev_init(dev_id, cfg->cpu_mode)); |
| |
| #if !(defined(KERNEL_MODULE) && defined(USER_MODE)) |
| { |
| /* |
| if(HSL_MDIO == cfg->reg_mode) |
| { |
| SW_RTN_ON_ERROR(shiva_bist_test(dev_id)); |
| |
| entry = 0x1; |
| HSL_REG_FIELD_SET(rv, dev_id, MASK_CTL, 0, SOFT_RST, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| i = 0x10; |
| do |
| { |
| HSL_REG_FIELD_GET(rv, dev_id, MASK_CTL, 0, SOFT_RST, |
| (a_uint8_t *) (&entry), sizeof (a_uint32_t)); |
| SW_RTN_ON_ERROR(rv); |
| |
| aos_mdelay(10); |
| } |
| while (entry && --i); |
| |
| if (0 == i) |
| { |
| return SW_INIT_ERROR; |
| } |
| } |
| */ |
| SW_RTN_ON_ERROR(hsl_port_prop_init(dev_id)); |
| SW_RTN_ON_ERROR(hsl_port_prop_init_by_dev(dev_id)); |
| SW_RTN_ON_ERROR(shiva_portproperty_init(dev_id, cfg->cpu_mode)); |
| |
| SHIVA_MIB_INIT(rv, dev_id); |
| SHIVA_PORT_CTRL_INIT(rv, dev_id); |
| SHIVA_PORTVLAN_INIT(rv, dev_id); |
| SHIVA_VLAN_INIT(rv, dev_id); |
| SHIVA_FDB_INIT(rv, dev_id); |
| SHIVA_QOS_INIT(rv, dev_id); |
| SHIVA_STP_INIT(rv, dev_id); |
| SHIVA_MIRR_INIT(rv, dev_id); |
| SHIVA_RATE_INIT(rv, dev_id); |
| SHIVA_MISC_INIT(rv, dev_id); |
| SHIVA_LEAKY_INIT(rv, dev_id); |
| SHIVA_IGMP_INIT(rv, dev_id); |
| SHIVA_ACL_INIT(rv, dev_id); |
| SHIVA_LED_INIT(rv, dev_id); |
| |
| { |
| hsl_api_t *p_api; |
| |
| SW_RTN_ON_NULL(p_api = hsl_api_ptr_get(dev_id)); |
| p_api->dev_reset = shiva_reset; |
| p_api->dev_clean = shiva_cleanup; |
| } |
| |
| /*SW_RTN_ON_ERROR(shiva_hw_init(dev_id, cfg));*/ |
| } |
| #endif |
| |
| return SW_OK; |
| } |
| |
| /** |
| * @} |
| */ |
| |
