@@ -565,40 +565,28 @@ static const struct cpsw_stats cpsw_gstrings_ch_stats[] = {
565
565
(func)(slave++, ##arg); \
566
566
} while (0)
567
567
568
- #define cpsw_dual_emac_src_port_detect (cpsw , status , ndev , skb ) \
569
- do { \
570
- if (!cpsw->data.dual_emac) \
571
- break; \
572
- if (CPDMA_RX_SOURCE_PORT(status) == 1) { \
573
- ndev = cpsw->slaves[0].ndev; \
574
- skb->dev = ndev; \
575
- } else if (CPDMA_RX_SOURCE_PORT(status) == 2) { \
576
- ndev = cpsw->slaves[1].ndev; \
577
- skb->dev = ndev; \
578
- } \
579
- } while (0)
580
- #define cpsw_add_mcast (cpsw , priv , addr ) \
581
- do { \
582
- if (cpsw->data.dual_emac) { \
583
- struct cpsw_slave *slave = cpsw->slaves + \
584
- priv->emac_port; \
585
- int slave_port = cpsw_get_slave_port( \
586
- slave->slave_num); \
587
- cpsw_ale_add_mcast(cpsw->ale, addr, \
588
- 1 << slave_port | ALE_PORT_HOST, \
589
- ALE_VLAN, slave->port_vlan, 0); \
590
- } else { \
591
- cpsw_ale_add_mcast(cpsw->ale, addr, \
592
- ALE_ALL_PORTS, \
593
- 0, 0, 0); \
594
- } \
595
- } while (0)
596
-
597
568
static inline int cpsw_get_slave_port (u32 slave_num )
598
569
{
599
570
return slave_num + 1 ;
600
571
}
601
572
573
+ static void cpsw_add_mcast (struct cpsw_priv * priv , u8 * addr )
574
+ {
575
+ struct cpsw_common * cpsw = priv -> cpsw ;
576
+
577
+ if (cpsw -> data .dual_emac ) {
578
+ struct cpsw_slave * slave = cpsw -> slaves + priv -> emac_port ;
579
+ int slave_port = cpsw_get_slave_port (slave -> slave_num );
580
+
581
+ cpsw_ale_add_mcast (cpsw -> ale , addr ,
582
+ 1 << slave_port | ALE_PORT_HOST ,
583
+ ALE_VLAN , slave -> port_vlan , 0 );
584
+ return ;
585
+ }
586
+
587
+ cpsw_ale_add_mcast (cpsw -> ale , addr , ALE_ALL_PORTS , 0 , 0 , 0 );
588
+ }
589
+
602
590
static void cpsw_set_promiscious (struct net_device * ndev , bool enable )
603
591
{
604
592
struct cpsw_common * cpsw = ndev_to_cpsw (ndev );
@@ -706,7 +694,7 @@ static void cpsw_ndo_set_rx_mode(struct net_device *ndev)
706
694
707
695
/* program multicast address list into ALE register */
708
696
netdev_for_each_mc_addr (ha , ndev ) {
709
- cpsw_add_mcast (cpsw , priv , ( u8 * ) ha -> addr );
697
+ cpsw_add_mcast (priv , ha -> addr );
710
698
}
711
699
}
712
700
}
@@ -798,10 +786,16 @@ static void cpsw_rx_handler(void *token, int len, int status)
798
786
struct sk_buff * skb = token ;
799
787
struct sk_buff * new_skb ;
800
788
struct net_device * ndev = skb -> dev ;
801
- int ret = 0 ;
789
+ int ret = 0 , port ;
802
790
struct cpsw_common * cpsw = ndev_to_cpsw (ndev );
803
791
804
- cpsw_dual_emac_src_port_detect (cpsw , status , ndev , skb );
792
+ if (cpsw -> data .dual_emac ) {
793
+ port = CPDMA_RX_SOURCE_PORT (status );
794
+ if (port ) {
795
+ ndev = cpsw -> slaves [-- port ].ndev ;
796
+ skb -> dev = ndev ;
797
+ }
798
+ }
805
799
806
800
if (unlikely (status < 0 ) || unlikely (!netif_running (ndev ))) {
807
801
/* In dual emac mode check for all interfaces */
0 commit comments