Source of vsc9953.c - uboot-phytec - PHYTEC BitBucket (Stash)

Ignore whitespace
Show whitespace characters
Hide e-diff
Unified diff
Side-by-side diff
Source viewDiff to previous
 
    vsc9953_port_all_vlan_aware_set(1);
    vsc9953_port_all_vlan_pvid_set(1);
    vsc9953_port_all_vlan_poncnt_set(1);
    vsc9953_vlan_table_membership_all_set(1, 1);
    vsc9953_vlan_ingr_fltr_learn_drop(1);
    vsc9953_port_all_vlan_egress_untagged_set(EGRESS_UNTAG_PVID_AND_ZERO);
    if (vsc9953_aggr_code_set(AGGR_CODE_ALL))
        debug("VSC9953: failed to set default aggregation code mode\n");
}
​
static void vcap_entry2cache_init(u32 target, u32 entry_words)
{
    int i;
​
    for (i = 0; i < entry_words; i++) {
        out_le32((unsigned int *)(VSC9953_OFFSET +
                VSC9953_VCAP_CACHE_ENTRY_DAT(target, i)), 0x00);
        out_le32((unsigned int *)(VSC9953_OFFSET +
                VSC9953_VCAP_CACHE_MASK_DAT(target, i)), 0xFF);
    }
​
    out_le32((unsigned int *)(VSC9953_OFFSET +
                VSC9953_VCAP_CACHE_TG_DAT(target)), 0x00);
    out_le32((unsigned int *)(VSC9953_OFFSET +
                  VSC9953_VCAP_CFG_MV_CFG(target)),
         VSC9953_VCAP_CFG_MV_CFG_SIZE(entry_words));
}
​
static void vcap_action2cache_init(u32 target, u32 action_words,
                   u32 counter_words)
{
    int i;
​
    for (i = 0; i < action_words; i++)
        out_le32((unsigned int *)(VSC9953_OFFSET +
                   VSC9953_VCAP_CACHE_ACTION_DAT(target, i)), 0x00);
​
    for (i = 0; i < counter_words; i++)
        out_le32((unsigned int *)(VSC9953_OFFSET +
                  VSC9953_VCAP_CACHE_CNT_DAT(target, i)), 0x00);
}
​
static int vcap_cmd(u32 target, u16 ix, int cmd, int sel, int entry_count)
{
    u32 tgt = target;
    u32 value = (VSC9953_VCAP_UPDATE_CTRL_UPDATE_CMD(cmd) |
             VSC9953_VCAP_UPDATE_CTRL_UPDATE_ADDR(ix) |
             VSC9953_VCAP_UPDATE_CTRL_UPDATE_SHOT);
​
    if ((sel & TCAM_SEL_ENTRY) && ix >= entry_count)
        return CMD_RET_FAILURE;
​
    if (!(sel & TCAM_SEL_ENTRY))
        value |= VSC9953_VCAP_UPDATE_CTRL_UPDATE_ENTRY_DIS;
​
    if (!(sel & TCAM_SEL_ACTION))
        value |= VSC9953_VCAP_UPDATE_CTRL_UPDATE_ACTION_DIS;
​
    if (!(sel & TCAM_SEL_COUNTER))
        value |= VSC9953_VCAP_UPDATE_CTRL_UPDATE_CNT_DIS;
​
    out_le32((unsigned int *)(VSC9953_OFFSET +
                VSC9953_VCAP_CFG_UPDATE_CTRL(tgt)), value);
​
    do {
        value = in_le32((unsigned int *)(VSC9953_OFFSET +
                VSC9953_VCAP_CFG_UPDATE_CTRL(tgt)));
​
    } while (value & VSC9953_VCAP_UPDATE_CTRL_UPDATE_SHOT);
​
    return CMD_RET_SUCCESS;
}
​
static void vsc9953_vcap_init(void)
{
    u32 tgt = VSC9953_ES0;
    int cmd_ret;
​
    /* write entries */
    vcap_entry2cache_init(tgt, ENTRY_WORDS_ES0);
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE, TCAM_SEL_ENTRY,
               ENTRY_WORDS_ES0);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid TCAM_SEL_ENTRY\n",
              __LINE__);
​
    /* write actions and counters */
    vcap_action2cache_init(tgt, BITS_TO_DWORD(ES0_ACT_WIDTH),
                   BITS_TO_DWORD(ES0_CNT_WIDTH));
    out_le32((unsigned int *)(VSC9953_OFFSET +
                  VSC9953_VCAP_CFG_MV_CFG(tgt)),
         VSC9953_VCAP_CFG_MV_CFG_SIZE(ES0_ACT_COUNT));
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE,
               TCAM_SEL_ACTION | TCAM_SEL_COUNTER, ENTRY_WORDS_ES0);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid TCAM_SEL_ACTION | TCAM_SEL_COUNTER\n",
              __LINE__);
​
    tgt = VSC9953_IS1;
​
    /* write entries */
    vcap_entry2cache_init(tgt, ENTRY_WORDS_IS1);
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE, TCAM_SEL_ENTRY,
               ENTRY_WORDS_IS1);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid TCAM_SEL_ENTRY\n",
              __LINE__);
​
    /* write actions and counters */
    vcap_action2cache_init(tgt, BITS_TO_DWORD(IS1_ACT_WIDTH),
                   BITS_TO_DWORD(IS1_CNT_WIDTH));
    out_le32((unsigned int *)(VSC9953_OFFSET +
                  VSC9953_VCAP_CFG_MV_CFG(tgt)),
         VSC9953_VCAP_CFG_MV_CFG_SIZE(IS1_ACT_COUNT));
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE,
               TCAM_SEL_ACTION | TCAM_SEL_COUNTER, ENTRY_WORDS_IS1);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid TCAM_SEL_ACTION | TCAM_SEL_COUNTER\n",
              __LINE__);
​
    tgt = VSC9953_IS2;
​
    /* write entries */
    vcap_entry2cache_init(tgt, ENTRY_WORDS_IS2);
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE, TCAM_SEL_ENTRY,
               ENTRY_WORDS_IS2);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid selection: TCAM_SEL_ENTRY\n",
              __LINE__);
​
    /* write actions and counters */
    vcap_action2cache_init(tgt, BITS_TO_DWORD(IS2_ACT_WIDTH),
                   BITS_TO_DWORD(IS2_CNT_WIDTH));
    out_le32((unsigned int *)(VSC9953_OFFSET +
                  VSC9953_VCAP_CFG_MV_CFG(tgt)),
         VSC9953_VCAP_CFG_MV_CFG_SIZE(IS2_ACT_COUNT));
    cmd_ret = vcap_cmd(tgt, 0, TCAM_CMD_INITIALIZE,
               TCAM_SEL_ACTION | TCAM_SEL_COUNTER, ENTRY_WORDS_IS2);
    if (cmd_ret != CMD_RET_SUCCESS)
        debug("VSC9953:%d invalid TCAM_SEL_ACTION | TCAM_SEL_COUNTER\n",
              __LINE__);
}
​
void vsc9953_init(bd_t *bis)
{
    u32 i;
    u32 hdx_cfg = 0;
    u32 phy_addr = 0;
    int timeout;
    struct vsc9953_system_reg *l2sys_reg;
    struct vsc9953_qsys_reg *l2qsys_reg;
    struct vsc9953_dev_gmii *l2dev_gmii_reg;
    struct vsc9953_analyzer *l2ana_reg;
Show more
​
            timeout = 50000;
            while ((vsc9953_mdio_read(&l2dev_gcb->mii_mng[0],
                    phy_addr, 0x01) & 0x0020) && --timeout)
                udelay(1); /* wait for AN to complete */
            if (timeout == 0)
                debug("Timeout waiting for AN to complete\n");
        }
    }
​
    vsc9953_vcap_init();
    vsc9953_default_configuration();
​
#ifdef CONFIG_CMD_ETHSW
    if (ethsw_define_functions(&vsc9953_cmd_func) < 0)
        debug("Unable to use \"ethsw\" commands\n");
#endif
​
    printf("VSC9953 L2 switch initialized\n");
    return;
}