diff options
Diffstat (limited to 'drivers/net/korina.c')
-rw-r--r-- | drivers/net/korina.c | 39 |
1 files changed, 30 insertions, 9 deletions
diff --git a/drivers/net/korina.c b/drivers/net/korina.c index 38d6649a29c4..b4cf602c32b0 100644 --- a/drivers/net/korina.c +++ b/drivers/net/korina.c | |||
@@ -133,6 +133,7 @@ struct korina_private { | |||
133 | int dma_halt_cnt; | 133 | int dma_halt_cnt; |
134 | int dma_run_cnt; | 134 | int dma_run_cnt; |
135 | struct napi_struct napi; | 135 | struct napi_struct napi; |
136 | struct timer_list media_check_timer; | ||
136 | struct mii_if_info mii_if; | 137 | struct mii_if_info mii_if; |
137 | struct net_device *dev; | 138 | struct net_device *dev; |
138 | int phy_addr; | 139 | int phy_addr; |
@@ -664,6 +665,15 @@ static void korina_check_media(struct net_device *dev, unsigned int init_media) | |||
664 | &lp->eth_regs->ethmac2); | 665 | &lp->eth_regs->ethmac2); |
665 | } | 666 | } |
666 | 667 | ||
668 | static void korina_poll_media(unsigned long data) | ||
669 | { | ||
670 | struct net_device *dev = (struct net_device *) data; | ||
671 | struct korina_private *lp = netdev_priv(dev); | ||
672 | |||
673 | korina_check_media(dev, 0); | ||
674 | mod_timer(&lp->media_check_timer, jiffies + HZ); | ||
675 | } | ||
676 | |||
667 | static void korina_set_carrier(struct mii_if_info *mii) | 677 | static void korina_set_carrier(struct mii_if_info *mii) |
668 | { | 678 | { |
669 | if (mii->force_media) { | 679 | if (mii->force_media) { |
@@ -1034,6 +1044,7 @@ static int korina_open(struct net_device *dev) | |||
1034 | dev->name, lp->und_irq); | 1044 | dev->name, lp->und_irq); |
1035 | goto err_free_ovr_irq; | 1045 | goto err_free_ovr_irq; |
1036 | } | 1046 | } |
1047 | mod_timer(&lp->media_check_timer, jiffies + 1); | ||
1037 | out: | 1048 | out: |
1038 | return ret; | 1049 | return ret; |
1039 | 1050 | ||
@@ -1053,6 +1064,8 @@ static int korina_close(struct net_device *dev) | |||
1053 | struct korina_private *lp = netdev_priv(dev); | 1064 | struct korina_private *lp = netdev_priv(dev); |
1054 | u32 tmp; | 1065 | u32 tmp; |
1055 | 1066 | ||
1067 | del_timer(&lp->media_check_timer); | ||
1068 | |||
1056 | /* Disable interrupts */ | 1069 | /* Disable interrupts */ |
1057 | disable_irq(lp->rx_irq); | 1070 | disable_irq(lp->rx_irq); |
1058 | disable_irq(lp->tx_irq); | 1071 | disable_irq(lp->tx_irq); |
@@ -1081,6 +1094,21 @@ static int korina_close(struct net_device *dev) | |||
1081 | return 0; | 1094 | return 0; |
1082 | } | 1095 | } |
1083 | 1096 | ||
1097 | static const struct net_device_ops korina_netdev_ops = { | ||
1098 | .ndo_open = korina_open, | ||
1099 | .ndo_stop = korina_close, | ||
1100 | .ndo_start_xmit = korina_send_packet, | ||
1101 | .ndo_set_multicast_list = korina_multicast_list, | ||
1102 | .ndo_tx_timeout = korina_tx_timeout, | ||
1103 | .ndo_do_ioctl = korina_ioctl, | ||
1104 | .ndo_change_mtu = eth_change_mtu, | ||
1105 | .ndo_validate_addr = eth_validate_addr, | ||
1106 | .ndo_set_mac_address = eth_mac_addr, | ||
1107 | #ifdef CONFIG_NET_POLL_CONTROLLER | ||
1108 | .ndo_poll_controller = korina_poll_controller, | ||
1109 | #endif | ||
1110 | }; | ||
1111 | |||
1084 | static int korina_probe(struct platform_device *pdev) | 1112 | static int korina_probe(struct platform_device *pdev) |
1085 | { | 1113 | { |
1086 | struct korina_device *bif = platform_get_drvdata(pdev); | 1114 | struct korina_device *bif = platform_get_drvdata(pdev); |
@@ -1149,17 +1177,9 @@ static int korina_probe(struct platform_device *pdev) | |||
1149 | dev->irq = lp->rx_irq; | 1177 | dev->irq = lp->rx_irq; |
1150 | lp->dev = dev; | 1178 | lp->dev = dev; |
1151 | 1179 | ||
1152 | dev->open = korina_open; | 1180 | dev->netdev_ops = &korina_netdev_ops; |
1153 | dev->stop = korina_close; | ||
1154 | dev->hard_start_xmit = korina_send_packet; | ||
1155 | dev->set_multicast_list = &korina_multicast_list; | ||
1156 | dev->ethtool_ops = &netdev_ethtool_ops; | 1181 | dev->ethtool_ops = &netdev_ethtool_ops; |
1157 | dev->tx_timeout = korina_tx_timeout; | ||
1158 | dev->watchdog_timeo = TX_TIMEOUT; | 1182 | dev->watchdog_timeo = TX_TIMEOUT; |
1159 | dev->do_ioctl = &korina_ioctl; | ||
1160 | #ifdef CONFIG_NET_POLL_CONTROLLER | ||
1161 | dev->poll_controller = korina_poll_controller; | ||
1162 | #endif | ||
1163 | netif_napi_add(dev, &lp->napi, korina_poll, 64); | 1183 | netif_napi_add(dev, &lp->napi, korina_poll, 64); |
1164 | 1184 | ||
1165 | lp->phy_addr = (((lp->rx_irq == 0x2c? 1:0) << 8) | 0x05); | 1185 | lp->phy_addr = (((lp->rx_irq == 0x2c? 1:0) << 8) | 0x05); |
@@ -1176,6 +1196,7 @@ static int korina_probe(struct platform_device *pdev) | |||
1176 | ": cannot register net device %d\n", rc); | 1196 | ": cannot register net device %d\n", rc); |
1177 | goto probe_err_register; | 1197 | goto probe_err_register; |
1178 | } | 1198 | } |
1199 | setup_timer(&lp->media_check_timer, korina_poll_media, (unsigned long) dev); | ||
1179 | out: | 1200 | out: |
1180 | return rc; | 1201 | return rc; |
1181 | 1202 | ||