]> git.sur5r.net Git - u-boot/blobdiff - drivers/net/vsc9953.c
spi: cadence_qspi: Fix warning cast from pointer to integer of different size
[u-boot] / drivers / net / vsc9953.c
index 5d196cfb3f382893f4691c3f9782128a15fe9157..f17839c70ff0bf029afce94ffddb402a043d8d0c 100644 (file)
@@ -2468,6 +2468,139 @@ void vsc9953_default_configuration(void)
                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;
@@ -2604,6 +2737,7 @@ void vsc9953_init(bd_t *bis)
                }
        }
 
+       vsc9953_vcap_init();
        vsc9953_default_configuration();
 
 #ifdef CONFIG_CMD_ETHSW