(func)(slave++, ##arg);                 \
        } while (0)
 
-#define cpsw_dual_emac_src_port_detect(cpsw, status, ndev, skb)                \
-       do {                                                            \
-               if (!cpsw->data.dual_emac)                              \
-                       break;                                          \
-               if (CPDMA_RX_SOURCE_PORT(status) == 1) {                \
-                       ndev = cpsw->slaves[0].ndev;                    \
-                       skb->dev = ndev;                                \
-               } else if (CPDMA_RX_SOURCE_PORT(status) == 2) {         \
-                       ndev = cpsw->slaves[1].ndev;                    \
-                       skb->dev = ndev;                                \
-               }                                                       \
-       } while (0)
-#define cpsw_add_mcast(cpsw, priv, addr)                               \
-       do {                                                            \
-               if (cpsw->data.dual_emac) {                             \
-                       struct cpsw_slave *slave = cpsw->slaves +       \
-                                               priv->emac_port;        \
-                       int slave_port = cpsw_get_slave_port(           \
-                                               slave->slave_num);      \
-                       cpsw_ale_add_mcast(cpsw->ale, addr,             \
-                               1 << slave_port | ALE_PORT_HOST,        \
-                               ALE_VLAN, slave->port_vlan, 0);         \
-               } else {                                                \
-                       cpsw_ale_add_mcast(cpsw->ale, addr,             \
-                               ALE_ALL_PORTS,                          \
-                               0, 0, 0);                               \
-               }                                                       \
-       } while (0)
-
 static inline int cpsw_get_slave_port(u32 slave_num)
 {
        return slave_num + 1;
 }
 
+static void cpsw_add_mcast(struct cpsw_priv *priv, u8 *addr)
+{
+       struct cpsw_common *cpsw = priv->cpsw;
+
+       if (cpsw->data.dual_emac) {
+               struct cpsw_slave *slave = cpsw->slaves + priv->emac_port;
+               int slave_port = cpsw_get_slave_port(slave->slave_num);
+
+               cpsw_ale_add_mcast(cpsw->ale, addr,
+                                  1 << slave_port | ALE_PORT_HOST,
+                                  ALE_VLAN, slave->port_vlan, 0);
+               return;
+       }
+
+       cpsw_ale_add_mcast(cpsw->ale, addr, ALE_ALL_PORTS, 0, 0, 0);
+}
+
 static void cpsw_set_promiscious(struct net_device *ndev, bool enable)
 {
        struct cpsw_common *cpsw = ndev_to_cpsw(ndev);
 
                /* program multicast address list into ALE register */
                netdev_for_each_mc_addr(ha, ndev) {
-                       cpsw_add_mcast(cpsw, priv, (u8 *)ha->addr);
+                       cpsw_add_mcast(priv, ha->addr);
                }
        }
 }
        struct sk_buff          *skb = token;
        struct sk_buff          *new_skb;
        struct net_device       *ndev = skb->dev;
-       int                     ret = 0;
+       int                     ret = 0, port;
        struct cpsw_common      *cpsw = ndev_to_cpsw(ndev);
 
-       cpsw_dual_emac_src_port_detect(cpsw, status, ndev, skb);
+       if (cpsw->data.dual_emac) {
+               port = CPDMA_RX_SOURCE_PORT(status);
+               if (port) {
+                       ndev = cpsw->slaves[--port].ndev;
+                       skb->dev = ndev;
+               }
+       }
 
        if (unlikely(status < 0) || unlikely(!netif_running(ndev))) {
                /* In dual emac mode check for all interfaces */