s2io_set_multicast

static void s2io_set_multicast(struct net_device *dev)

{
    int i, j, prev_cnt;
    struct netdev_hw_addr *ha;
    struct s2io_nic *sp = netdev_priv(dev);
    struct XENA_dev_config __iomem *bar0 = sp->bar0;
    u64 val64 = 0, multi_mac = 0x010203040506ULL, mask =
        0xfeffffffffffULL;
    u64 dis_addr = S2IO_DISABLE_MAC_ENTRY, mac_addr = 0;
    void __iomem *add;
    struct config_param *config = &sp->config;

    if ((dev->flags & IFF_ALLMULTI) && (!sp->m_cast_flg)) {
        /*  Enable all Multicast addresses */
        writeq(RMAC_ADDR_DATA0_MEM_ADDR(multi_mac),
               &bar0->rmac_addr_data0_mem);
        writeq(RMAC_ADDR_DATA1_MEM_MASK(mask),
               &bar0->rmac_addr_data1_mem);
        val64 = RMAC_ADDR_CMD_MEM_WE |
            RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
            RMAC_ADDR_CMD_MEM_OFFSET(config->max_mc_addr - 1);
        writeq(val64, &bar0->rmac_addr_cmd_mem);
        /* Wait till command completes */
        wait_for_cmd_complete(&bar0->rmac_addr_cmd_mem,
                      RMAC_ADDR_CMD_MEM_STROBE_CMD_EXECUTING,
                      S2IO_BIT_RESET);

        sp->m_cast_flg = 1;
        sp->all_multi_pos = config->max_mc_addr - 1;
    } else if ((dev->flags & IFF_ALLMULTI) && (sp->m_cast_flg)) {
        /*  Disable all Multicast addresses */
        writeq(RMAC_ADDR_DATA0_MEM_ADDR(dis_addr),
               &bar0->rmac_addr_data0_mem);
        writeq(RMAC_ADDR_DATA1_MEM_MASK(0x0),
               &bar0->rmac_addr_data1_mem);
        val64 = RMAC_ADDR_CMD_MEM_WE |
            RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
            RMAC_ADDR_CMD_MEM_OFFSET(sp->all_multi_pos);
        writeq(val64, &bar0->rmac_addr_cmd_mem);
        /* Wait till command completes */
        wait_for_cmd_complete(&bar0->rmac_addr_cmd_mem,
                      RMAC_ADDR_CMD_MEM_STROBE_CMD_EXECUTING,
                      S2IO_BIT_RESET);

        sp->m_cast_flg = 0;
        sp->all_multi_pos = 0;
    }

    if ((dev->flags & IFF_PROMISC) && (!sp->promisc_flg)) {
        /*  Put the NIC into promiscuous mode */
        add = &bar0->mac_cfg;
        val64 = readq(&bar0->mac_cfg);
        val64 |= MAC_CFG_RMAC_PROM_ENABLE;

        writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
        writel((u32)val64, add);
        writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
        writel((u32) (val64 >> 32), (add + 4));

        if (vlan_tag_strip != 1) {
            val64 = readq(&bar0->rx_pa_cfg);
            val64 &= ~RX_PA_CFG_STRIP_VLAN_TAG;
            writeq(val64, &bar0->rx_pa_cfg);
            sp->vlan_strip_flag = 0;
        }

        val64 = readq(&bar0->mac_cfg);
        sp->promisc_flg = 1;
        DBG_PRINT(INFO_DBG, "%s: entered promiscuous mode\n",
              dev->name);
    } else if (!(dev->flags & IFF_PROMISC) && (sp->promisc_flg)) {
        /*  Remove the NIC from promiscuous mode */
        add = &bar0->mac_cfg;
        val64 = readq(&bar0->mac_cfg);
        val64 &= ~MAC_CFG_RMAC_PROM_ENABLE;

        writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
        writel((u32)val64, add);
        writeq(RMAC_CFG_KEY(0x4C0D), &bar0->rmac_cfg_key);
        writel((u32) (val64 >> 32), (add + 4));

        if (vlan_tag_strip != 0) {
            val64 = readq(&bar0->rx_pa_cfg);
            val64 |= RX_PA_CFG_STRIP_VLAN_TAG;
            writeq(val64, &bar0->rx_pa_cfg);
            sp->vlan_strip_flag = 1;
        }

        val64 = readq(&bar0->mac_cfg);
        sp->promisc_flg = 0;
        DBG_PRINT(INFO_DBG, "%s: left promiscuous mode\n", dev->name);
    }

    /*  Update individual M_CAST address list */
    if ((!sp->m_cast_flg) && netdev_mc_count(dev)) {
        if (netdev_mc_count(dev) >
            (config->max_mc_addr - config->max_mac_addr)) {
            DBG_PRINT(ERR_DBG,
                  "%s: No more Rx filters can be added - "
                  "please enable ALL_MULTI instead\n",
                  dev->name);
            return;
        }

        prev_cnt = sp->mc_addr_count;
        sp->mc_addr_count = netdev_mc_count(dev);

        /* Clear out the previous list of Mc in the H/W. */
        for (i = 0; i < prev_cnt; i++) {
            writeq(RMAC_ADDR_DATA0_MEM_ADDR(dis_addr),
                   &bar0->rmac_addr_data0_mem);
            writeq(RMAC_ADDR_DATA1_MEM_MASK(0ULL),
                   &bar0->rmac_addr_data1_mem);
            val64 = RMAC_ADDR_CMD_MEM_WE |
                RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
                RMAC_ADDR_CMD_MEM_OFFSET
                (config->mc_start_offset + i);
            writeq(val64, &bar0->rmac_addr_cmd_mem);

            /* Wait for command completes */
            if (wait_for_cmd_complete(&bar0->rmac_addr_cmd_mem,
                          RMAC_ADDR_CMD_MEM_STROBE_CMD_EXECUTING,
                          S2IO_BIT_RESET)) {
                DBG_PRINT(ERR_DBG,
                      "%s: Adding Multicasts failed\n",
                      dev->name);
                return;
            }
        }

        /* Create the new Rx filter list and update the same in H/W. */
        i = 0;
        netdev_for_each_mc_addr(ha, dev) {
            mac_addr = 0;
            for (j = 0; j < ETH_ALEN; j++) {
                mac_addr |= ha->addr[j];
                mac_addr <<= 8;
            }
            mac_addr >>= 8;
            writeq(RMAC_ADDR_DATA0_MEM_ADDR(mac_addr),
                   &bar0->rmac_addr_data0_mem);
            writeq(RMAC_ADDR_DATA1_MEM_MASK(0ULL),
                   &bar0->rmac_addr_data1_mem);
            val64 = RMAC_ADDR_CMD_MEM_WE |
                RMAC_ADDR_CMD_MEM_STROBE_NEW_CMD |
                RMAC_ADDR_CMD_MEM_OFFSET
                (i + config->mc_start_offset);
            writeq(val64, &bar0->rmac_addr_cmd_mem);

            /* Wait for command completes */
            if (wait_for_cmd_complete(&bar0->rmac_addr_cmd_mem,
                          RMAC_ADDR_CMD_MEM_STROBE_CMD_EXECUTING,
                          S2IO_BIT_RESET)) {
                DBG_PRINT(ERR_DBG,
                      "%s: Adding Multicasts failed\n",
                      dev->name);
                return;
            }
            i++;
        }
    }
}