diff options
Diffstat (limited to 'drivers/net')
33 files changed, 695 insertions, 860 deletions
diff --git a/drivers/net/au1000_eth.c b/drivers/net/au1000_eth.c index 1363083b4d83..14dbad14afb6 100644 --- a/drivers/net/au1000_eth.c +++ b/drivers/net/au1000_eth.c | |||
| @@ -52,6 +52,7 @@ | |||
| 52 | #include <linux/mii.h> | 52 | #include <linux/mii.h> |
| 53 | #include <linux/skbuff.h> | 53 | #include <linux/skbuff.h> |
| 54 | #include <linux/delay.h> | 54 | #include <linux/delay.h> |
| 55 | #include <linux/crc32.h> | ||
| 55 | #include <asm/mipsregs.h> | 56 | #include <asm/mipsregs.h> |
| 56 | #include <asm/irq.h> | 57 | #include <asm/irq.h> |
| 57 | #include <asm/io.h> | 58 | #include <asm/io.h> |
| @@ -2070,23 +2071,6 @@ static void au1000_tx_timeout(struct net_device *dev) | |||
| 2070 | netif_wake_queue(dev); | 2071 | netif_wake_queue(dev); |
| 2071 | } | 2072 | } |
| 2072 | 2073 | ||
| 2073 | |||
| 2074 | static unsigned const ethernet_polynomial = 0x04c11db7U; | ||
| 2075 | static inline u32 ether_crc(int length, unsigned char *data) | ||
| 2076 | { | ||
| 2077 | int crc = -1; | ||
| 2078 | |||
| 2079 | while(--length >= 0) { | ||
| 2080 | unsigned char current_octet = *data++; | ||
| 2081 | int bit; | ||
| 2082 | for (bit = 0; bit < 8; bit++, current_octet >>= 1) | ||
| 2083 | crc = (crc << 1) ^ | ||
| 2084 | ((crc < 0) ^ (current_octet & 1) ? | ||
| 2085 | ethernet_polynomial : 0); | ||
| 2086 | } | ||
| 2087 | return crc; | ||
| 2088 | } | ||
| 2089 | |||
| 2090 | static void set_rx_mode(struct net_device *dev) | 2074 | static void set_rx_mode(struct net_device *dev) |
| 2091 | { | 2075 | { |
| 2092 | struct au1000_private *aup = (struct au1000_private *) dev->priv; | 2076 | struct au1000_private *aup = (struct au1000_private *) dev->priv; |
diff --git a/drivers/net/b44.c b/drivers/net/b44.c index 3d306681919e..d8233e0b7899 100644 --- a/drivers/net/b44.c +++ b/drivers/net/b44.c | |||
| @@ -650,9 +650,11 @@ static int b44_alloc_rx_skb(struct b44 *bp, int src_idx, u32 dest_idx_unmasked) | |||
| 650 | 650 | ||
| 651 | /* Hardware bug work-around, the chip is unable to do PCI DMA | 651 | /* Hardware bug work-around, the chip is unable to do PCI DMA |
| 652 | to/from anything above 1GB :-( */ | 652 | to/from anything above 1GB :-( */ |
| 653 | if (mapping + RX_PKT_BUF_SZ > B44_DMA_MASK) { | 653 | if (dma_mapping_error(mapping) || |
| 654 | mapping + RX_PKT_BUF_SZ > B44_DMA_MASK) { | ||
| 654 | /* Sigh... */ | 655 | /* Sigh... */ |
| 655 | pci_unmap_single(bp->pdev, mapping, RX_PKT_BUF_SZ,PCI_DMA_FROMDEVICE); | 656 | if (!dma_mapping_error(mapping)) |
| 657 | pci_unmap_single(bp->pdev, mapping, RX_PKT_BUF_SZ,PCI_DMA_FROMDEVICE); | ||
| 656 | dev_kfree_skb_any(skb); | 658 | dev_kfree_skb_any(skb); |
| 657 | skb = __dev_alloc_skb(RX_PKT_BUF_SZ,GFP_DMA); | 659 | skb = __dev_alloc_skb(RX_PKT_BUF_SZ,GFP_DMA); |
| 658 | if (skb == NULL) | 660 | if (skb == NULL) |
| @@ -660,8 +662,10 @@ static int b44_alloc_rx_skb(struct b44 *bp, int src_idx, u32 dest_idx_unmasked) | |||
| 660 | mapping = pci_map_single(bp->pdev, skb->data, | 662 | mapping = pci_map_single(bp->pdev, skb->data, |
| 661 | RX_PKT_BUF_SZ, | 663 | RX_PKT_BUF_SZ, |
| 662 | PCI_DMA_FROMDEVICE); | 664 | PCI_DMA_FROMDEVICE); |
| 663 | if (mapping + RX_PKT_BUF_SZ > B44_DMA_MASK) { | 665 | if (dma_mapping_error(mapping) || |
| 664 | pci_unmap_single(bp->pdev, mapping, RX_PKT_BUF_SZ,PCI_DMA_FROMDEVICE); | 666 | mapping + RX_PKT_BUF_SZ > B44_DMA_MASK) { |
| 667 | if (!dma_mapping_error(mapping)) | ||
| 668 | pci_unmap_single(bp->pdev, mapping, RX_PKT_BUF_SZ,PCI_DMA_FROMDEVICE); | ||
| 665 | dev_kfree_skb_any(skb); | 669 | dev_kfree_skb_any(skb); |
| 666 | return -ENOMEM; | 670 | return -ENOMEM; |
| 667 | } | 671 | } |
| @@ -967,9 +971,10 @@ static int b44_start_xmit(struct sk_buff *skb, struct net_device *dev) | |||
| 967 | } | 971 | } |
| 968 | 972 | ||
| 969 | mapping = pci_map_single(bp->pdev, skb->data, len, PCI_DMA_TODEVICE); | 973 | mapping = pci_map_single(bp->pdev, skb->data, len, PCI_DMA_TODEVICE); |
| 970 | if (mapping + len > B44_DMA_MASK) { | 974 | if (dma_mapping_error(mapping) || mapping + len > B44_DMA_MASK) { |
| 971 | /* Chip can't handle DMA to/from >1GB, use bounce buffer */ | 975 | /* Chip can't handle DMA to/from >1GB, use bounce buffer */ |
| 972 | pci_unmap_single(bp->pdev, mapping, len, PCI_DMA_TODEVICE); | 976 | if (!dma_mapping_error(mapping)) |
| 977 | pci_unmap_single(bp->pdev, mapping, len, PCI_DMA_TODEVICE); | ||
| 973 | 978 | ||
| 974 | bounce_skb = __dev_alloc_skb(TX_PKT_BUF_SZ, | 979 | bounce_skb = __dev_alloc_skb(TX_PKT_BUF_SZ, |
| 975 | GFP_ATOMIC|GFP_DMA); | 980 | GFP_ATOMIC|GFP_DMA); |
| @@ -978,8 +983,9 @@ static int b44_start_xmit(struct sk_buff *skb, struct net_device *dev) | |||
| 978 | 983 | ||
| 979 | mapping = pci_map_single(bp->pdev, bounce_skb->data, | 984 | mapping = pci_map_single(bp->pdev, bounce_skb->data, |
| 980 | len, PCI_DMA_TODEVICE); | 985 | len, PCI_DMA_TODEVICE); |
| 981 | if (mapping + len > B44_DMA_MASK) { | 986 | if (dma_mapping_error(mapping) || mapping + len > B44_DMA_MASK) { |
| 982 | pci_unmap_single(bp->pdev, mapping, | 987 | if (!dma_mapping_error(mapping)) |
| 988 | pci_unmap_single(bp->pdev, mapping, | ||
| 983 | len, PCI_DMA_TODEVICE); | 989 | len, PCI_DMA_TODEVICE); |
| 984 | dev_kfree_skb_any(bounce_skb); | 990 | dev_kfree_skb_any(bounce_skb); |
| 985 | goto err_out; | 991 | goto err_out; |
| @@ -1203,7 +1209,8 @@ static int b44_alloc_consistent(struct b44 *bp) | |||
| 1203 | DMA_TABLE_BYTES, | 1209 | DMA_TABLE_BYTES, |
| 1204 | DMA_BIDIRECTIONAL); | 1210 | DMA_BIDIRECTIONAL); |
| 1205 | 1211 | ||
| 1206 | if (rx_ring_dma + size > B44_DMA_MASK) { | 1212 | if (dma_mapping_error(rx_ring_dma) || |
| 1213 | rx_ring_dma + size > B44_DMA_MASK) { | ||
| 1207 | kfree(rx_ring); | 1214 | kfree(rx_ring); |
| 1208 | goto out_err; | 1215 | goto out_err; |
| 1209 | } | 1216 | } |
| @@ -1229,7 +1236,8 @@ static int b44_alloc_consistent(struct b44 *bp) | |||
| 1229 | DMA_TABLE_BYTES, | 1236 | DMA_TABLE_BYTES, |
| 1230 | DMA_TO_DEVICE); | 1237 | DMA_TO_DEVICE); |
| 1231 | 1238 | ||
| 1232 | if (tx_ring_dma + size > B44_DMA_MASK) { | 1239 | if (dma_mapping_error(tx_ring_dma) || |
| 1240 | tx_ring_dma + size > B44_DMA_MASK) { | ||
| 1233 | kfree(tx_ring); | 1241 | kfree(tx_ring); |
| 1234 | goto out_err; | 1242 | goto out_err; |
| 1235 | } | 1243 | } |
diff --git a/drivers/net/bnx2.c b/drivers/net/bnx2.c index 5ca99e26660a..54161aef3cac 100644 --- a/drivers/net/bnx2.c +++ b/drivers/net/bnx2.c | |||
| @@ -55,8 +55,8 @@ | |||
| 55 | 55 | ||
| 56 | #define DRV_MODULE_NAME "bnx2" | 56 | #define DRV_MODULE_NAME "bnx2" |
| 57 | #define PFX DRV_MODULE_NAME ": " | 57 | #define PFX DRV_MODULE_NAME ": " |
| 58 | #define DRV_MODULE_VERSION "1.4.39" | 58 | #define DRV_MODULE_VERSION "1.4.40" |
| 59 | #define DRV_MODULE_RELDATE "March 22, 2006" | 59 | #define DRV_MODULE_RELDATE "May 22, 2006" |
| 60 | 60 | ||
| 61 | #define RUN_AT(x) (jiffies + (x)) | 61 | #define RUN_AT(x) (jiffies + (x)) |
| 62 | 62 | ||
| @@ -2945,7 +2945,7 @@ bnx2_nvram_write(struct bnx2 *bp, u32 offset, u8 *data_buf, | |||
| 2945 | int buf_size) | 2945 | int buf_size) |
| 2946 | { | 2946 | { |
| 2947 | u32 written, offset32, len32; | 2947 | u32 written, offset32, len32; |
| 2948 | u8 *buf, start[4], end[4]; | 2948 | u8 *buf, start[4], end[4], *flash_buffer = NULL; |
| 2949 | int rc = 0; | 2949 | int rc = 0; |
| 2950 | int align_start, align_end; | 2950 | int align_start, align_end; |
| 2951 | 2951 | ||
| @@ -2985,12 +2985,19 @@ bnx2_nvram_write(struct bnx2 *bp, u32 offset, u8 *data_buf, | |||
| 2985 | memcpy(buf + align_start, data_buf, buf_size); | 2985 | memcpy(buf + align_start, data_buf, buf_size); |
| 2986 | } | 2986 | } |
| 2987 | 2987 | ||
| 2988 | if (bp->flash_info->buffered == 0) { | ||
| 2989 | flash_buffer = kmalloc(264, GFP_KERNEL); | ||
| 2990 | if (flash_buffer == NULL) { | ||
| 2991 | rc = -ENOMEM; | ||
| 2992 | goto nvram_write_end; | ||
| 2993 | } | ||
| 2994 | } | ||
| 2995 | |||
| 2988 | written = 0; | 2996 | written = 0; |
| 2989 | while ((written < len32) && (rc == 0)) { | 2997 | while ((written < len32) && (rc == 0)) { |
| 2990 | u32 page_start, page_end, data_start, data_end; | 2998 | u32 page_start, page_end, data_start, data_end; |
| 2991 | u32 addr, cmd_flags; | 2999 | u32 addr, cmd_flags; |
| 2992 | int i; | 3000 | int i; |
| 2993 | u8 flash_buffer[264]; | ||
| 2994 | 3001 | ||
| 2995 | /* Find the page_start addr */ | 3002 | /* Find the page_start addr */ |
| 2996 | page_start = offset32 + written; | 3003 | page_start = offset32 + written; |
| @@ -3061,7 +3068,7 @@ bnx2_nvram_write(struct bnx2 *bp, u32 offset, u8 *data_buf, | |||
| 3061 | } | 3068 | } |
| 3062 | 3069 | ||
| 3063 | /* Loop to write the new data from data_start to data_end */ | 3070 | /* Loop to write the new data from data_start to data_end */ |
| 3064 | for (addr = data_start; addr < data_end; addr += 4, i++) { | 3071 | for (addr = data_start; addr < data_end; addr += 4, i += 4) { |
| 3065 | if ((addr == page_end - 4) || | 3072 | if ((addr == page_end - 4) || |
| 3066 | ((bp->flash_info->buffered) && | 3073 | ((bp->flash_info->buffered) && |
| 3067 | (addr == data_end - 4))) { | 3074 | (addr == data_end - 4))) { |
| @@ -3109,6 +3116,9 @@ bnx2_nvram_write(struct bnx2 *bp, u32 offset, u8 *data_buf, | |||
| 3109 | } | 3116 | } |
| 3110 | 3117 | ||
| 3111 | nvram_write_end: | 3118 | nvram_write_end: |
| 3119 | if (bp->flash_info->buffered == 0) | ||
| 3120 | kfree(flash_buffer); | ||
| 3121 | |||
| 3112 | if (align_start || align_end) | 3122 | if (align_start || align_end) |
| 3113 | kfree(buf); | 3123 | kfree(buf); |
| 3114 | return rc; | 3124 | return rc; |
diff --git a/drivers/net/dl2k.c b/drivers/net/dl2k.c index 1f3627470c95..038447fb5c5e 100644 --- a/drivers/net/dl2k.c +++ b/drivers/net/dl2k.c | |||
| @@ -53,6 +53,7 @@ | |||
| 53 | #define DRV_VERSION "v1.17b" | 53 | #define DRV_VERSION "v1.17b" |
| 54 | #define DRV_RELDATE "2006/03/10" | 54 | #define DRV_RELDATE "2006/03/10" |
| 55 | #include "dl2k.h" | 55 | #include "dl2k.h" |
| 56 | #include <linux/dma-mapping.h> | ||
| 56 | 57 | ||
| 57 | static char version[] __devinitdata = | 58 | static char version[] __devinitdata = |
| 58 | KERN_INFO DRV_NAME " " DRV_VERSION " " DRV_RELDATE "\n"; | 59 | KERN_INFO DRV_NAME " " DRV_VERSION " " DRV_RELDATE "\n"; |
| @@ -765,7 +766,7 @@ rio_free_tx (struct net_device *dev, int irq) | |||
| 765 | break; | 766 | break; |
| 766 | skb = np->tx_skbuff[entry]; | 767 | skb = np->tx_skbuff[entry]; |
| 767 | pci_unmap_single (np->pdev, | 768 | pci_unmap_single (np->pdev, |
| 768 | np->tx_ring[entry].fraginfo & 0xffffffffffff, | 769 | np->tx_ring[entry].fraginfo & DMA_48BIT_MASK, |
| 769 | skb->len, PCI_DMA_TODEVICE); | 770 | skb->len, PCI_DMA_TODEVICE); |
| 770 | if (irq) | 771 | if (irq) |
| 771 | dev_kfree_skb_irq (skb); | 772 | dev_kfree_skb_irq (skb); |
| @@ -893,7 +894,7 @@ receive_packet (struct net_device *dev) | |||
| 893 | /* Small skbuffs for short packets */ | 894 | /* Small skbuffs for short packets */ |
| 894 | if (pkt_len > copy_thresh) { | 895 | if (pkt_len > copy_thresh) { |
| 895 | pci_unmap_single (np->pdev, | 896 | pci_unmap_single (np->pdev, |
| 896 | desc->fraginfo & 0xffffffffffff, | 897 | desc->fraginfo & DMA_48BIT_MASK, |
| 897 | np->rx_buf_sz, | 898 | np->rx_buf_sz, |
| 898 | PCI_DMA_FROMDEVICE); | 899 | PCI_DMA_FROMDEVICE); |
| 899 | skb_put (skb = np->rx_skbuff[entry], pkt_len); | 900 | skb_put (skb = np->rx_skbuff[entry], pkt_len); |
| @@ -901,7 +902,7 @@ receive_packet (struct net_device *dev) | |||
| 901 | } else if ((skb = dev_alloc_skb (pkt_len + 2)) != NULL) { | 902 | } else if ((skb = dev_alloc_skb (pkt_len + 2)) != NULL) { |
| 902 | pci_dma_sync_single_for_cpu(np->pdev, | 903 | pci_dma_sync_single_for_cpu(np->pdev, |
| 903 | desc->fraginfo & | 904 | desc->fraginfo & |
| 904 | 0xffffffffffff, | 905 | DMA_48BIT_MASK, |
| 905 | np->rx_buf_sz, | 906 | np->rx_buf_sz, |
| 906 | PCI_DMA_FROMDEVICE); | 907 | PCI_DMA_FROMDEVICE); |
| 907 | skb->dev = dev; | 908 | skb->dev = dev; |
| @@ -913,7 +914,7 @@ receive_packet (struct net_device *dev) | |||
| 913 | skb_put (skb, pkt_len); | 914 | skb_put (skb, pkt_len); |
| 914 | pci_dma_sync_single_for_device(np->pdev, | 915 | pci_dma_sync_single_for_device(np->pdev, |
| 915 | desc->fraginfo & | 916 | desc->fraginfo & |
| 916 | 0xffffffffffff, | 917 | DMA_48BIT_MASK, |
| 917 | np->rx_buf_sz, | 918 | np->rx_buf_sz, |
| 918 | PCI_DMA_FROMDEVICE); | 919 | PCI_DMA_FROMDEVICE); |
| 919 | } | 920 | } |
| @@ -1800,7 +1801,7 @@ rio_close (struct net_device *dev) | |||
| 1800 | skb = np->rx_skbuff[i]; | 1801 | skb = np->rx_skbuff[i]; |
| 1801 | if (skb) { | 1802 | if (skb) { |
| 1802 | pci_unmap_single(np->pdev, | 1803 | pci_unmap_single(np->pdev, |
| 1803 | np->rx_ring[i].fraginfo & 0xffffffffffff, | 1804 | np->rx_ring[i].fraginfo & DMA_48BIT_MASK, |
| 1804 | skb->len, PCI_DMA_FROMDEVICE); | 1805 | skb->len, PCI_DMA_FROMDEVICE); |
| 1805 | dev_kfree_skb (skb); | 1806 | dev_kfree_skb (skb); |
| 1806 | np->rx_skbuff[i] = NULL; | 1807 | np->rx_skbuff[i] = NULL; |
| @@ -1810,7 +1811,7 @@ rio_close (struct net_device *dev) | |||
| 1810 | skb = np->tx_skbuff[i]; | 1811 | skb = np->tx_skbuff[i]; |
| 1811 | if (skb) { | 1812 | if (skb) { |
| 1812 | pci_unmap_single(np->pdev, | 1813 | pci_unmap_single(np->pdev, |
| 1813 | np->tx_ring[i].fraginfo & 0xffffffffffff, | 1814 | np->tx_ring[i].fraginfo & DMA_48BIT_MASK, |
| 1814 | skb->len, PCI_DMA_TODEVICE); | 1815 | skb->len, PCI_DMA_TODEVICE); |
| 1815 | dev_kfree_skb (skb); | 1816 | dev_kfree_skb (skb); |
| 1816 | np->tx_skbuff[i] = NULL; | 1817 | np->tx_skbuff[i] = NULL; |
diff --git a/drivers/net/forcedeth.c b/drivers/net/forcedeth.c index f7235c9bc421..705e1229d89d 100644 --- a/drivers/net/forcedeth.c +++ b/drivers/net/forcedeth.c | |||
| @@ -2891,78 +2891,6 @@ static int nv_open(struct net_device *dev) | |||
| 2891 | goto out_drain; | 2891 | goto out_drain; |
| 2892 | } | 2892 | } |
| 2893 | 2893 | ||
| 2894 | if (np->msi_flags & NV_MSI_X_CAPABLE) { | ||
| 2895 | for (i = 0; i < (np->msi_flags & NV_MSI_X_VECTORS_MASK); i++) { | ||
| 2896 | np->msi_x_entry[i].entry = i; | ||
| 2897 | } | ||
| 2898 | if ((ret = pci_enable_msix(np->pci_dev, np->msi_x_entry, (np->msi_flags & NV_MSI_X_VECTORS_MASK))) == 0) { | ||
| 2899 | np->msi_flags |= NV_MSI_X_ENABLED; | ||
| 2900 | if (optimization_mode == NV_OPTIMIZATION_MODE_THROUGHPUT) { | ||
| 2901 | /* Request irq for rx handling */ | ||
| 2902 | if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_RX].vector, &nv_nic_irq_rx, SA_SHIRQ, dev->name, dev) != 0) { | ||
| 2903 | printk(KERN_INFO "forcedeth: request_irq failed for rx %d\n", ret); | ||
| 2904 | pci_disable_msix(np->pci_dev); | ||
| 2905 | np->msi_flags &= ~NV_MSI_X_ENABLED; | ||
| 2906 | goto out_drain; | ||
| 2907 | } | ||
| 2908 | /* Request irq for tx handling */ | ||
| 2909 | if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_TX].vector, &nv_nic_irq_tx, SA_SHIRQ, dev->name, dev) != 0) { | ||
| 2910 | printk(KERN_INFO "forcedeth: request_irq failed for tx %d\n", ret); | ||
| 2911 | pci_disable_msix(np->pci_dev); | ||
| 2912 | np->msi_flags &= ~NV_MSI_X_ENABLED; | ||
| 2913 | goto out_drain; | ||
| 2914 | } | ||
| 2915 | /* Request irq for link and timer handling */ | ||
| 2916 | if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_OTHER].vector, &nv_nic_irq_other, SA_SHIRQ, dev->name, dev) != 0) { | ||
| 2917 | printk(KERN_INFO "forcedeth: request_irq failed for link %d\n", ret); | ||
| 2918 | pci_disable_msix(np->pci_dev); | ||
| 2919 | np->msi_flags &= ~NV_MSI_X_ENABLED; | ||
| 2920 | goto out_drain; | ||
| 2921 | } | ||
| 2922 | |||
| 2923 | /* map interrupts to their respective vector */ | ||
| 2924 | writel(0, base + NvRegMSIXMap0); | ||
| 2925 | writel(0, base + NvRegMSIXMap1); | ||
| 2926 | set_msix_vector_map(dev, NV_MSI_X_VECTOR_RX, NVREG_IRQ_RX_ALL); | ||
| 2927 | set_msix_vector_map(dev, NV_MSI_X_VECTOR_TX, NVREG_IRQ_TX_ALL); | ||
| 2928 | set_msix_vector_map(dev, NV_MSI_X_VECTOR_OTHER, NVREG_IRQ_OTHER); | ||
| 2929 | } else { | ||
| 2930 | /* Request irq for all interrupts */ | ||
| 2931 | if (request_irq(np->msi_x_entry[NV_MSI_X_VECTOR_ALL].vector, &nv_nic_irq, SA_SHIRQ, dev->name, dev) != 0) { | ||
| 2932 | printk(KERN_INFO "forcedeth: request_irq failed %d\n", ret); | ||
| 2933 | pci_disable_msix(np->pci_dev); | ||
| 2934 | np->msi_flags &= ~NV_MSI_X_ENABLED; | ||
| 2935 | goto out_drain; | ||
| 2936 | } | ||
| 2937 | |||
| 2938 | /* map interrupts to vector 0 */ | ||
| 2939 | writel(0, base + NvRegMSIXMap0); | ||
| 2940 | writel(0, base + NvRegMSIXMap1); | ||
| 2941 | } | ||
| 2942 | } | ||
| 2943 | } | ||
| 2944 | if (ret != 0 && np->msi_flags & NV_MSI_CAPABLE) { | ||
| 2945 | if ((ret = pci_enable_msi(np->pci_dev)) == 0) { | ||
| 2946 | np->msi_flags |= NV_MSI_ENABLED; | ||
| 2947 | if (request_irq(np->pci_dev->irq, &nv_nic_irq, SA_SHIRQ, dev->name, dev) != 0) { | ||
| 2948 | printk(KERN_INFO "forcedeth: request_irq failed %d\n", ret); | ||
| 2949 | pci_disable_msi(np->pci_dev); | ||
| 2950 | np->msi_flags &= ~NV_MSI_ENABLED; | ||
| 2951 | goto out_drain; | ||
| 2952 | } | ||
| 2953 | |||
| 2954 | /* map interrupts to vector 0 */ | ||
| 2955 | writel(0, base + NvRegMSIMap0); | ||
| 2956 | writel(0, base + NvRegMSIMap1); | ||
| 2957 | /* enable msi vector 0 */ | ||
| 2958 | writel(NVREG_MSI_VECTOR_0_ENABLED, base + NvRegMSIIrqMask); | ||
| 2959 | } | ||
| 2960 | } | ||
| 2961 | if (ret != 0) { | ||
| 2962 | if (request_irq(np->pci_dev->irq, &nv_nic_irq, SA_SHIRQ, dev->name, dev) != 0) | ||
| 2963 | goto out_drain; | ||
| 2964 | } | ||
| 2965 | |||
| 2966 | /* ask for interrupts */ | 2894 | /* ask for interrupts */ |
| 2967 | nv_enable_hw_interrupts(dev, np->irqmask); | 2895 | nv_enable_hw_interrupts(dev, np->irqmask); |
| 2968 | 2896 | ||
diff --git a/drivers/net/irda/Makefile b/drivers/net/irda/Makefile index 27ab75f20799..c1ce2398efea 100644 --- a/drivers/net/irda/Makefile +++ b/drivers/net/irda/Makefile | |||
| @@ -46,4 +46,4 @@ obj-$(CONFIG_MA600_DONGLE) += ma600-sir.o | |||
| 46 | obj-$(CONFIG_TOIM3232_DONGLE) += toim3232-sir.o | 46 | obj-$(CONFIG_TOIM3232_DONGLE) += toim3232-sir.o |
| 47 | 47 | ||
| 48 | # The SIR helper module | 48 | # The SIR helper module |
| 49 | sir-dev-objs := sir_dev.o sir_dongle.o sir_kthread.o | 49 | sir-dev-objs := sir_dev.o sir_dongle.o |
diff --git a/drivers/net/irda/irda-usb.c b/drivers/net/irda/irda-usb.c index 96bdb73c2283..cd87593e4e8a 100644 --- a/drivers/net/irda/irda-usb.c +++ b/drivers/net/irda/irda-usb.c | |||
| @@ -1778,7 +1778,7 @@ static int irda_usb_probe(struct usb_interface *intf, | |||
| 1778 | 1778 | ||
| 1779 | if (self->needspatch) { | 1779 | if (self->needspatch) { |
| 1780 | ret = usb_control_msg (self->usbdev, usb_sndctrlpipe (self->usbdev, 0), | 1780 | ret = usb_control_msg (self->usbdev, usb_sndctrlpipe (self->usbdev, 0), |
| 1781 | 0x02, 0x40, 0, 0, 0, 0, msecs_to_jiffies(500)); | 1781 | 0x02, 0x40, 0, 0, NULL, 0, 500); |
| 1782 | if (ret < 0) { | 1782 | if (ret < 0) { |
| 1783 | IRDA_DEBUG (0, "usb_control_msg failed %d\n", ret); | 1783 | IRDA_DEBUG (0, "usb_control_msg failed %d\n", ret); |
| 1784 | goto err_out_3; | 1784 | goto err_out_3; |
diff --git a/drivers/net/irda/sir-dev.h b/drivers/net/irda/sir-dev.h index f69fb4cec76f..9fa294a546d6 100644 --- a/drivers/net/irda/sir-dev.h +++ b/drivers/net/irda/sir-dev.h | |||
| @@ -15,23 +15,14 @@ | |||
| 15 | #define IRDA_SIR_H | 15 | #define IRDA_SIR_H |
| 16 | 16 | ||
| 17 | #include <linux/netdevice.h> | 17 | #include <linux/netdevice.h> |
| 18 | #include <linux/workqueue.h> | ||
| 18 | 19 | ||
| 19 | #include <net/irda/irda.h> | 20 | #include <net/irda/irda.h> |
| 20 | #include <net/irda/irda_device.h> // iobuff_t | 21 | #include <net/irda/irda_device.h> // iobuff_t |
| 21 | 22 | ||
| 22 | /* FIXME: unify irda_request with sir_fsm! */ | ||
| 23 | |||
| 24 | struct irda_request { | ||
| 25 | struct list_head lh_request; | ||
| 26 | unsigned long pending; | ||
| 27 | void (*func)(void *); | ||
| 28 | void *data; | ||
| 29 | struct timer_list timer; | ||
| 30 | }; | ||
| 31 | |||
| 32 | struct sir_fsm { | 23 | struct sir_fsm { |
| 33 | struct semaphore sem; | 24 | struct semaphore sem; |
| 34 | struct irda_request rq; | 25 | struct work_struct work; |
| 35 | unsigned state, substate; | 26 | unsigned state, substate; |
| 36 | int param; | 27 | int param; |
| 37 | int result; | 28 | int result; |
diff --git a/drivers/net/irda/sir_dev.c b/drivers/net/irda/sir_dev.c index ea7c9464d46a..3b5854d10c17 100644 --- a/drivers/net/irda/sir_dev.c +++ b/drivers/net/irda/sir_dev.c | |||
| @@ -23,6 +23,298 @@ | |||
| 23 | 23 | ||
| 24 | #include "sir-dev.h" | 24 | #include "sir-dev.h" |
| 25 | 25 | ||
| 26 | |||
| 27 | static struct workqueue_struct *irda_sir_wq; | ||
| 28 | |||
| 29 | /* STATE MACHINE */ | ||
| 30 | |||
| 31 | /* substate handler of the config-fsm to handle the cases where we want | ||
| 32 | * to wait for transmit completion before changing the port configuration | ||
| 33 | */ | ||
| 34 | |||
| 35 | static int sirdev_tx_complete_fsm(struct sir_dev *dev) | ||
| 36 | { | ||
| 37 | struct sir_fsm *fsm = &dev->fsm; | ||
| 38 | unsigned next_state, delay; | ||
| 39 | unsigned bytes_left; | ||
| 40 | |||
| 41 | do { | ||
| 42 | next_state = fsm->substate; /* default: stay in current substate */ | ||
| 43 | delay = 0; | ||
| 44 | |||
| 45 | switch(fsm->substate) { | ||
| 46 | |||
| 47 | case SIRDEV_STATE_WAIT_XMIT: | ||
| 48 | if (dev->drv->chars_in_buffer) | ||
| 49 | bytes_left = dev->drv->chars_in_buffer(dev); | ||
| 50 | else | ||
| 51 | bytes_left = 0; | ||
| 52 | if (!bytes_left) { | ||
| 53 | next_state = SIRDEV_STATE_WAIT_UNTIL_SENT; | ||
| 54 | break; | ||
| 55 | } | ||
| 56 | |||
| 57 | if (dev->speed > 115200) | ||
| 58 | delay = (bytes_left*8*10000) / (dev->speed/100); | ||
| 59 | else if (dev->speed > 0) | ||
| 60 | delay = (bytes_left*10*10000) / (dev->speed/100); | ||
| 61 | else | ||
| 62 | delay = 0; | ||
| 63 | /* expected delay (usec) until remaining bytes are sent */ | ||
| 64 | if (delay < 100) { | ||
| 65 | udelay(delay); | ||
| 66 | delay = 0; | ||
| 67 | break; | ||
| 68 | } | ||
| 69 | /* sleep some longer delay (msec) */ | ||
| 70 | delay = (delay+999) / 1000; | ||
| 71 | break; | ||
| 72 | |||
| 73 | case SIRDEV_STATE_WAIT_UNTIL_SENT: | ||
| 74 | /* block until underlaying hardware buffer are empty */ | ||
| 75 | if (dev->drv->wait_until_sent) | ||
| 76 | dev->drv->wait_until_sent(dev); | ||
| 77 | next_state = SIRDEV_STATE_TX_DONE; | ||
| 78 | break; | ||
| 79 | |||
| 80 | case SIRDEV_STATE_TX_DONE: | ||
| 81 | return 0; | ||
| 82 | |||
| 83 | default: | ||
| 84 | IRDA_ERROR("%s - undefined state\n", __FUNCTION__); | ||
| 85 | return -EINVAL; | ||
| 86 | } | ||
| 87 | fsm->substate = next_state; | ||
| 88 | } while (delay == 0); | ||
| 89 | return delay; | ||
| 90 | } | ||
| 91 | |||
| 92 | /* | ||
| 93 | * Function sirdev_config_fsm | ||
| 94 | * | ||
| 95 | * State machine to handle the configuration of the device (and attached dongle, if any). | ||
| 96 | * This handler is scheduled for execution in kIrDAd context, so we can sleep. | ||
| 97 | * however, kIrDAd is shared by all sir_dev devices so we better don't sleep there too | ||
| 98 | * long. Instead, for longer delays we start a timer to reschedule us later. | ||
| 99 | * On entry, fsm->sem is always locked and the netdev xmit queue stopped. | ||
| 100 | * Both must be unlocked/restarted on completion - but only on final exit. | ||
| 101 | */ | ||
| 102 | |||
| 103 | static void sirdev_config_fsm(void *data) | ||
| 104 | { | ||
| 105 | struct sir_dev *dev = data; | ||
| 106 | struct sir_fsm *fsm = &dev->fsm; | ||
| 107 | int next_state; | ||
| 108 | int ret = -1; | ||
| 109 | unsigned delay; | ||
| 110 | |||
| 111 | IRDA_DEBUG(2, "%s(), <%ld>\n", __FUNCTION__, jiffies); | ||
| 112 | |||
| 113 | do { | ||
| 114 | IRDA_DEBUG(3, "%s - state=0x%04x / substate=0x%04x\n", | ||
| 115 | __FUNCTION__, fsm->state, fsm->substate); | ||
| 116 | |||
| 117 | next_state = fsm->state; | ||
| 118 | delay = 0; | ||
| 119 | |||
| 120 | switch(fsm->state) { | ||
| 121 | |||
| 122 | case SIRDEV_STATE_DONGLE_OPEN: | ||
| 123 | if (dev->dongle_drv != NULL) { | ||
| 124 | ret = sirdev_put_dongle(dev); | ||
| 125 | if (ret) { | ||
| 126 | fsm->result = -EINVAL; | ||
| 127 | next_state = SIRDEV_STATE_ERROR; | ||
| 128 | break; | ||
| 129 | } | ||
| 130 | } | ||
| 131 | |||
| 132 | /* Initialize dongle */ | ||
| 133 | ret = sirdev_get_dongle(dev, fsm->param); | ||
| 134 | if (ret) { | ||
| 135 | fsm->result = ret; | ||
| 136 | next_state = SIRDEV_STATE_ERROR; | ||
| 137 | break; | ||
| 138 | } | ||
| 139 | |||
| 140 | /* Dongles are powered through the modem control lines which | ||
| 141 | * were just set during open. Before resetting, let's wait for | ||
| 142 | * the power to stabilize. This is what some dongle drivers did | ||
| 143 | * in open before, while others didn't - should be safe anyway. | ||
| 144 | */ | ||
| 145 | |||
| 146 | delay = 50; | ||
| 147 | fsm->substate = SIRDEV_STATE_DONGLE_RESET; | ||
| 148 | next_state = SIRDEV_STATE_DONGLE_RESET; | ||
| 149 | |||
| 150 | fsm->param = 9600; | ||
| 151 | |||
| 152 | break; | ||
| 153 | |||
| 154 | case SIRDEV_STATE_DONGLE_CLOSE: | ||
| 155 | /* shouldn't we just treat this as success=? */ | ||
| 156 | if (dev->dongle_drv == NULL) { | ||
| 157 | fsm->result = -EINVAL; | ||
| 158 | next_state = SIRDEV_STATE_ERROR; | ||
| 159 | break; | ||
| 160 | } | ||
| 161 | |||
| 162 | ret = sirdev_put_dongle(dev); | ||
| 163 | if (ret) { | ||
| 164 | fsm->result = ret; | ||
| 165 | next_state = SIRDEV_STATE_ERROR; | ||
| 166 | break; | ||
| 167 | } | ||
| 168 | next_state = SIRDEV_STATE_DONE; | ||
| 169 | break; | ||
| 170 | |||
| 171 | case SIRDEV_STATE_SET_DTR_RTS: | ||
| 172 | ret = sirdev_set_dtr_rts(dev, | ||
| 173 | (fsm->param&0x02) ? TRUE : FALSE, | ||
| 174 | (fsm->param&0x01) ? TRUE : FALSE); | ||
| 175 | next_state = SIRDEV_STATE_DONE; | ||
| 176 | break; | ||
| 177 | |||
| 178 | case SIRDEV_STATE_SET_SPEED: | ||
| 179 | fsm->substate = SIRDEV_STATE_WAIT_XMIT; | ||
| 180 | next_state = SIRDEV_STATE_DONGLE_CHECK; | ||
| 181 | break; | ||
| 182 | |||
| 183 | case SIRDEV_STATE_DONGLE_CHECK: | ||
| 184 | ret = sirdev_tx_complete_fsm(dev); | ||
| 185 | if (ret < 0) { | ||
| 186 | fsm->result = ret; | ||
| 187 | next_state = SIRDEV_STATE_ERROR; | ||
| 188 | break; | ||
| 189 | } | ||
| 190 | if ((delay=ret) != 0) | ||
| 191 | break; | ||
| 192 | |||
| 193 | if (dev->dongle_drv) { | ||
| 194 | fsm->substate = SIRDEV_STATE_DONGLE_RESET; | ||
| 195 | next_state = SIRDEV_STATE_DONGLE_RESET; | ||
| 196 | } | ||
| 197 | else { | ||
| 198 | dev->speed = fsm->param; | ||
| 199 | next_state = SIRDEV_STATE_PORT_SPEED; | ||
| 200 | } | ||
| 201 | break; | ||
| 202 | |||
| 203 | case SIRDEV_STATE_DONGLE_RESET: | ||
| 204 | if (dev->dongle_drv->reset) { | ||
| 205 | ret = dev->dongle_drv->reset(dev); | ||
| 206 | if (ret < 0) { | ||
| 207 | fsm->result = ret; | ||
| 208 | next_state = SIRDEV_STATE_ERROR; | ||
| 209 | break; | ||
| 210 | } | ||
| 211 | } | ||
| 212 | else | ||
| 213 | ret = 0; | ||
| 214 | if ((delay=ret) == 0) { | ||
| 215 | /* set serial port according to dongle default speed */ | ||
| 216 | if (dev->drv->set_speed) | ||
| 217 | dev->drv->set_speed(dev, dev->speed); | ||
| 218 | fsm->substate = SIRDEV_STATE_DONGLE_SPEED; | ||
| 219 | next_state = SIRDEV_STATE_DONGLE_SPEED; | ||
| 220 | } | ||
| 221 | break; | ||
| 222 | |||
| 223 | case SIRDEV_STATE_DONGLE_SPEED: | ||
| 224 | if (dev->dongle_drv->reset) { | ||
| 225 | ret = dev->dongle_drv->set_speed(dev, fsm->param); | ||
| 226 | if (ret < 0) { | ||
| 227 | fsm->result = ret; | ||
| 228 | next_state = SIRDEV_STATE_ERROR; | ||
| 229 | break; | ||
| 230 | } | ||
| 231 | } | ||
| 232 | else | ||
| 233 | ret = 0; | ||
| 234 | if ((delay=ret) == 0) | ||
| 235 | next_state = SIRDEV_STATE_PORT_SPEED; | ||
| 236 | break; | ||
| 237 | |||
| 238 | case SIRDEV_STATE_PORT_SPEED: | ||
| 239 | /* Finally we are ready to change the serial port speed */ | ||
| 240 | if (dev->drv->set_speed) | ||
| 241 | dev->drv->set_speed(dev, dev->speed); | ||
| 242 | dev->new_speed = 0; | ||
| 243 | next_state = SIRDEV_STATE_DONE; | ||
| 244 | break; | ||
| 245 | |||
| 246 | case SIRDEV_STATE_DONE: | ||
| 247 | /* Signal network layer so it can send more frames */ | ||
| 248 | netif_wake_queue(dev->netdev); | ||
| 249 | next_state = SIRDEV_STATE_COMPLETE; | ||
| 250 | break; | ||
| 251 | |||
| 252 | default: | ||
| 253 | IRDA_ERROR("%s - undefined state\n", __FUNCTION__); | ||
| 254 | fsm->result = -EINVAL; | ||
| 255 | /* fall thru */ | ||
| 256 | |||
| 257 | case SIRDEV_STATE_ERROR: | ||
| 258 | IRDA_ERROR("%s - error: %d\n", __FUNCTION__, fsm->result); | ||
| 259 | |||
| 260 | #if 0 /* don't enable this before we have netdev->tx_timeout to recover */ | ||
| 261 | netif_stop_queue(dev->netdev); | ||
| 262 | #else | ||
| 263 | netif_wake_queue(dev->netdev); | ||
| 264 | #endif | ||
| 265 | /* fall thru */ | ||
| 266 | |||
| 267 | case SIRDEV_STATE_COMPLETE: | ||
| 268 | /* config change finished, so we are not busy any longer */ | ||
| 269 | sirdev_enable_rx(dev); | ||
| 270 | up(&fsm->sem); | ||
| 271 | return; | ||
| 272 | } | ||
| 273 | fsm->state = next_state; | ||
| 274 | } while(!delay); | ||
| 275 | |||
| 276 | queue_delayed_work(irda_sir_wq, &fsm->work, msecs_to_jiffies(delay)); | ||
| 277 | } | ||
| 278 | |||
| 279 | /* schedule some device configuration task for execution by kIrDAd | ||
| 280 | * on behalf of the above state machine. | ||
| 281 | * can be called from process or interrupt/tasklet context. | ||
| 282 | */ | ||
| 283 | |||
| 284 | int sirdev_schedule_request(struct sir_dev *dev, int initial_state, unsigned param) | ||
| 285 | { | ||
| 286 | struct sir_fsm *fsm = &dev->fsm; | ||
| 287 | |||
| 288 | IRDA_DEBUG(2, "%s - state=0x%04x / param=%u\n", __FUNCTION__, initial_state, param); | ||
| 289 | |||
| 290 | if (down_trylock(&fsm->sem)) { | ||
| 291 | if (in_interrupt() || in_atomic() || irqs_disabled()) { | ||
| 292 | IRDA_DEBUG(1, "%s(), state machine busy!\n", __FUNCTION__); | ||
| 293 | return -EWOULDBLOCK; | ||
| 294 | } else | ||
| 295 | down(&fsm->sem); | ||
| 296 | } | ||
| 297 | |||
| 298 | if (fsm->state == SIRDEV_STATE_DEAD) { | ||
| 299 | /* race with sirdev_close should never happen */ | ||
| 300 | IRDA_ERROR("%s(), instance staled!\n", __FUNCTION__); | ||
| 301 | up(&fsm->sem); | ||
| 302 | return -ESTALE; /* or better EPIPE? */ | ||
| 303 | } | ||
| 304 | |||
| 305 | netif_stop_queue(dev->netdev); | ||
| 306 | atomic_set(&dev->enable_rx, 0); | ||
| 307 | |||
| 308 | fsm->state = initial_state; | ||
| 309 | fsm->param = param; | ||
| 310 | fsm->result = 0; | ||
| 311 | |||
| 312 | INIT_WORK(&fsm->work, sirdev_config_fsm, dev); | ||
| 313 | queue_work(irda_sir_wq, &fsm->work); | ||
| 314 | return 0; | ||
| 315 | } | ||
| 316 | |||
| 317 | |||
| 26 | /***************************************************************************/ | 318 | /***************************************************************************/ |
| 27 | 319 | ||
| 28 | void sirdev_enable_rx(struct sir_dev *dev) | 320 | void sirdev_enable_rx(struct sir_dev *dev) |
| @@ -619,10 +911,6 @@ struct sir_dev * sirdev_get_instance(const struct sir_driver *drv, const char *n | |||
| 619 | spin_lock_init(&dev->tx_lock); | 911 | spin_lock_init(&dev->tx_lock); |
| 620 | init_MUTEX(&dev->fsm.sem); | 912 | init_MUTEX(&dev->fsm.sem); |
| 621 | 913 | ||
| 622 | INIT_LIST_HEAD(&dev->fsm.rq.lh_request); | ||
| 623 | dev->fsm.rq.pending = 0; | ||
| 624 | init_timer(&dev->fsm.rq.timer); | ||
| 625 | |||
| 626 | dev->drv = drv; | 914 | dev->drv = drv; |
| 627 | dev->netdev = ndev; | 915 | dev->netdev = ndev; |
| 628 | 916 | ||
| @@ -682,3 +970,22 @@ int sirdev_put_instance(struct sir_dev *dev) | |||
| 682 | } | 970 | } |
| 683 | EXPORT_SYMBOL(sirdev_put_instance); | 971 | EXPORT_SYMBOL(sirdev_put_instance); |
| 684 | 972 | ||
| 973 | static int __init sir_wq_init(void) | ||
| 974 | { | ||
| 975 | irda_sir_wq = create_singlethread_workqueue("irda_sir_wq"); | ||
| 976 | if (!irda_sir_wq) | ||
| 977 | return -ENOMEM; | ||
| 978 | return 0; | ||
| 979 | } | ||
| 980 | |||
| 981 | static void __exit sir_wq_exit(void) | ||
| 982 | { | ||
| 983 | destroy_workqueue(irda_sir_wq); | ||
| 984 | } | ||
| 985 | |||
| 986 | module_init(sir_wq_init); | ||
| 987 | module_exit(sir_wq_exit); | ||
| 988 | |||
| 989 | MODULE_AUTHOR("Martin Diehl <info@mdiehl.de>"); | ||
| 990 | MODULE_DESCRIPTION("IrDA SIR core"); | ||
| 991 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/net/irda/sir_kthread.c b/drivers/net/irda/sir_kthread.c deleted file mode 100644 index e3904d6bfecd..000000000000 --- a/drivers/net/irda/sir_kthread.c +++ /dev/null | |||
| @@ -1,508 +0,0 @@ | |||
| 1 | /********************************************************************* | ||
| 2 | * | ||
| 3 | * sir_kthread.c: dedicated thread to process scheduled | ||
| 4 | * sir device setup requests | ||
| 5 | * | ||
| 6 | * Copyright (c) 2002 Martin Diehl | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or | ||
| 9 | * modify it under the terms of the GNU General Public License as | ||
| 10 | * published by the Free Software Foundation; either version 2 of | ||
| 11 | * the License, or (at your option) any later version. | ||
| 12 | * | ||
| 13 | ********************************************************************/ | ||
| 14 | |||
| 15 | #include <linux/module.h> | ||
| 16 | #include <linux/kernel.h> | ||
| 17 | #include <linux/version.h> | ||
| 18 | #include <linux/init.h> | ||
| 19 | #include <linux/smp_lock.h> | ||
| 20 | #include <linux/completion.h> | ||
| 21 | #include <linux/delay.h> | ||
| 22 | |||
| 23 | #include <net/irda/irda.h> | ||
| 24 | |||
| 25 | #include "sir-dev.h" | ||
| 26 | |||
| 27 | /************************************************************************** | ||
| 28 | * | ||
| 29 | * kIrDAd kernel thread and config state machine | ||
| 30 | * | ||
| 31 | */ | ||
| 32 | |||
| 33 | struct irda_request_queue { | ||
| 34 | struct list_head request_list; | ||
| 35 | spinlock_t lock; | ||
| 36 | task_t *thread; | ||
| 37 | struct completion exit; | ||
| 38 | wait_queue_head_t kick, done; | ||
| 39 | atomic_t num_pending; | ||
| 40 | }; | ||
| 41 | |||
| 42 | static struct irda_request_queue irda_rq_queue; | ||
| 43 | |||
| 44 | static int irda_queue_request(struct irda_request *rq) | ||
| 45 | { | ||
| 46 | int ret = 0; | ||
| 47 | unsigned long flags; | ||
| 48 | |||
| 49 | if (!test_and_set_bit(0, &rq->pending)) { | ||
| 50 | spin_lock_irqsave(&irda_rq_queue.lock, flags); | ||
| 51 | list_add_tail(&rq->lh_request, &irda_rq_queue.request_list); | ||
| 52 | wake_up(&irda_rq_queue.kick); | ||
| 53 | atomic_inc(&irda_rq_queue.num_pending); | ||
| 54 | spin_unlock_irqrestore(&irda_rq_queue.lock, flags); | ||
| 55 | ret = 1; | ||
| 56 | } | ||
| 57 | return ret; | ||
| 58 | } | ||
| 59 | |||
| 60 | static void irda_request_timer(unsigned long data) | ||
| 61 | { | ||
| 62 | struct irda_request *rq = (struct irda_request *)data; | ||
| 63 | unsigned long flags; | ||
| 64 | |||
| 65 | spin_lock_irqsave(&irda_rq_queue.lock, flags); | ||
| 66 | list_add_tail(&rq->lh_request, &irda_rq_queue.request_list); | ||
| 67 | wake_up(&irda_rq_queue.kick); | ||
| 68 | spin_unlock_irqrestore(&irda_rq_queue.lock, flags); | ||
| 69 | } | ||
| 70 | |||
| 71 | static int irda_queue_delayed_request(struct irda_request *rq, unsigned long delay) | ||
| 72 | { | ||
| 73 | int ret = 0; | ||
| 74 | struct timer_list *timer = &rq->timer; | ||
| 75 | |||
| 76 | if (!test_and_set_bit(0, &rq->pending)) { | ||
| 77 | timer->expires = jiffies + delay; | ||
| 78 | timer->function = irda_request_timer; | ||
| 79 | timer->data = (unsigned long)rq; | ||
| 80 | atomic_inc(&irda_rq_queue.num_pending); | ||
| 81 | add_timer(timer); | ||
| 82 | ret = 1; | ||
| 83 | } | ||
| 84 | return ret; | ||
| 85 | } | ||
| 86 | |||
| 87 | static void run_irda_queue(void) | ||
| 88 | { | ||
| 89 | unsigned long flags; | ||
| 90 | struct list_head *entry, *tmp; | ||
| 91 | struct irda_request *rq; | ||
| 92 | |||
| 93 | spin_lock_irqsave(&irda_rq_queue.lock, flags); | ||
| 94 | list_for_each_safe(entry, tmp, &irda_rq_queue.request_list) { | ||
| 95 | rq = list_entry(entry, struct irda_request, lh_request); | ||
| 96 | list_del_init(entry); | ||
| 97 | spin_unlock_irqrestore(&irda_rq_queue.lock, flags); | ||
| 98 | |||
| 99 | clear_bit(0, &rq->pending); | ||
| 100 | rq->func(rq->data); | ||
| 101 | |||
| 102 | if (atomic_dec_and_test(&irda_rq_queue.num_pending)) | ||
| 103 | wake_up(&irda_rq_queue.done); | ||
| 104 | |||
| 105 | spin_lock_irqsave(&irda_rq_queue.lock, flags); | ||
| 106 | } | ||
| 107 | spin_unlock_irqrestore(&irda_rq_queue.lock, flags); | ||
| 108 | } | ||
| 109 | |||
| 110 | static int irda_thread(void *startup) | ||
| 111 | { | ||
| 112 | DECLARE_WAITQUEUE(wait, current); | ||
| 113 | |||
| 114 | daemonize("kIrDAd"); | ||
| 115 | |||
| 116 | irda_rq_queue.thread = current; | ||
| 117 | |||
| 118 | complete((struct completion *)startup); | ||
| 119 | |||
| 120 | while (irda_rq_queue.thread != NULL) { | ||
| 121 | |||
| 122 | /* We use TASK_INTERRUPTIBLE, rather than | ||
| 123 | * TASK_UNINTERRUPTIBLE. Andrew Morton made this | ||
| 124 | * change ; he told me that it is safe, because "signal | ||
| 125 | * blocking is now handled in daemonize()", he added | ||
| 126 | * that the problem is that "uninterruptible sleep | ||
| 127 | * contributes to load average", making user worry. | ||
| 128 | * Jean II */ | ||
| 129 | set_task_state(current, TASK_INTERRUPTIBLE); | ||
| 130 | add_wait_queue(&irda_rq_queue.kick, &wait); | ||
| 131 | if (list_empty(&irda_rq_queue.request_list)) | ||
| 132 | schedule(); | ||
| 133 | else | ||
| 134 | __set_task_state(current, TASK_RUNNING); | ||
| 135 | remove_wait_queue(&irda_rq_queue.kick, &wait); | ||
| 136 | |||
| 137 | /* make swsusp happy with our thread */ | ||
| 138 | try_to_freeze(); | ||
| 139 | |||
| 140 | run_irda_queue(); | ||
| 141 | } | ||
| 142 | |||
| 143 | #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,35) | ||
| 144 | reparent_to_init(); | ||
| 145 | #endif | ||
| 146 | complete_and_exit(&irda_rq_queue.exit, 0); | ||
| 147 | /* never reached */ | ||
| 148 | return 0; | ||
| 149 | } | ||
| 150 | |||
| 151 | |||
| 152 | static void flush_irda_queue(void) | ||
| 153 | { | ||
| 154 | if (atomic_read(&irda_rq_queue.num_pending)) { | ||
| 155 | |||
| 156 | DECLARE_WAITQUEUE(wait, current); | ||
| 157 | |||
| 158 | if (!list_empty(&irda_rq_queue.request_list)) | ||
| 159 | run_irda_queue(); | ||
| 160 | |||
| 161 | set_task_state(current, TASK_UNINTERRUPTIBLE); | ||
| 162 | add_wait_queue(&irda_rq_queue.done, &wait); | ||
| 163 | if (atomic_read(&irda_rq_queue.num_pending)) | ||
| 164 | schedule(); | ||
| 165 | else | ||
| 166 | __set_task_state(current, TASK_RUNNING); | ||
| 167 | remove_wait_queue(&irda_rq_queue.done, &wait); | ||
| 168 | } | ||
| 169 | } | ||
| 170 | |||
| 171 | /* substate handler of the config-fsm to handle the cases where we want | ||
| 172 | * to wait for transmit completion before changing the port configuration | ||
| 173 | */ | ||
| 174 | |||
| 175 | static int irda_tx_complete_fsm(struct sir_dev *dev) | ||
| 176 | { | ||
| 177 | struct sir_fsm *fsm = &dev->fsm; | ||
| 178 | unsigned next_state, delay; | ||
| 179 | unsigned bytes_left; | ||
| 180 | |||
| 181 | do { | ||
| 182 | next_state = fsm->substate; /* default: stay in current substate */ | ||
| 183 | delay = 0; | ||
| 184 | |||
| 185 | switch(fsm->substate) { | ||
| 186 | |||
| 187 | case SIRDEV_STATE_WAIT_XMIT: | ||
| 188 | if (dev->drv->chars_in_buffer) | ||
| 189 | bytes_left = dev->drv->chars_in_buffer(dev); | ||
| 190 | else | ||
| 191 | bytes_left = 0; | ||
| 192 | if (!bytes_left) { | ||
| 193 | next_state = SIRDEV_STATE_WAIT_UNTIL_SENT; | ||
| 194 | break; | ||
| 195 | } | ||
| 196 | |||
| 197 | if (dev->speed > 115200) | ||
| 198 | delay = (bytes_left*8*10000) / (dev->speed/100); | ||
| 199 | else if (dev->speed > 0) | ||
| 200 | delay = (bytes_left*10*10000) / (dev->speed/100); | ||
| 201 | else | ||
| 202 | delay = 0; | ||
| 203 | /* expected delay (usec) until remaining bytes are sent */ | ||
| 204 | if (delay < 100) { | ||
| 205 | udelay(delay); | ||
| 206 | delay = 0; | ||
| 207 | break; | ||
| 208 | } | ||
| 209 | /* sleep some longer delay (msec) */ | ||
| 210 | delay = (delay+999) / 1000; | ||
| 211 | break; | ||
| 212 | |||
| 213 | case SIRDEV_STATE_WAIT_UNTIL_SENT: | ||
| 214 | /* block until underlaying hardware buffer are empty */ | ||
| 215 | if (dev->drv->wait_until_sent) | ||
| 216 | dev->drv->wait_until_sent(dev); | ||
| 217 | next_state = SIRDEV_STATE_TX_DONE; | ||
| 218 | break; | ||
| 219 | |||
| 220 | case SIRDEV_STATE_TX_DONE: | ||
| 221 | return 0; | ||
| 222 | |||
| 223 | default: | ||
| 224 | IRDA_ERROR("%s - undefined state\n", __FUNCTION__); | ||
| 225 | return -EINVAL; | ||
| 226 | } | ||
| 227 | fsm->substate = next_state; | ||
| 228 | } while (delay == 0); | ||
| 229 | return delay; | ||
| 230 | } | ||
| 231 | |||
| 232 | /* | ||
| 233 | * Function irda_config_fsm | ||
| 234 | * | ||
| 235 | * State machine to handle the configuration of the device (and attached dongle, if any). | ||
| 236 | * This handler is scheduled for execution in kIrDAd context, so we can sleep. | ||
| 237 | * however, kIrDAd is shared by all sir_dev devices so we better don't sleep there too | ||
| 238 | * long. Instead, for longer delays we start a timer to reschedule us later. | ||
| 239 | * On entry, fsm->sem is always locked and the netdev xmit queue stopped. | ||
| 240 | * Both must be unlocked/restarted on completion - but only on final exit. | ||
| 241 | */ | ||
| 242 | |||
| 243 | static void irda_config_fsm(void *data) | ||
| 244 | { | ||
| 245 | struct sir_dev *dev = data; | ||
| 246 | struct sir_fsm *fsm = &dev->fsm; | ||
| 247 | int next_state; | ||
| 248 | int ret = -1; | ||
| 249 | unsigned delay; | ||
| 250 | |||
| 251 | IRDA_DEBUG(2, "%s(), <%ld>\n", __FUNCTION__, jiffies); | ||
| 252 | |||
| 253 | do { | ||
| 254 | IRDA_DEBUG(3, "%s - state=0x%04x / substate=0x%04x\n", | ||
| 255 | __FUNCTION__, fsm->state, fsm->substate); | ||
| 256 | |||
| 257 | next_state = fsm->state; | ||
| 258 | delay = 0; | ||
| 259 | |||
| 260 | switch(fsm->state) { | ||
| 261 | |||
| 262 | case SIRDEV_STATE_DONGLE_OPEN: | ||
| 263 | if (dev->dongle_drv != NULL) { | ||
| 264 | ret = sirdev_put_dongle(dev); | ||
| 265 | if (ret) { | ||
| 266 | fsm->result = -EINVAL; | ||
| 267 | next_state = SIRDEV_STATE_ERROR; | ||
| 268 | break; | ||
| 269 | } | ||
| 270 | } | ||
| 271 | |||
| 272 | /* Initialize dongle */ | ||
| 273 | ret = sirdev_get_dongle(dev, fsm->param); | ||
| 274 | if (ret) { | ||
| 275 | fsm->result = ret; | ||
| 276 | next_state = SIRDEV_STATE_ERROR; | ||
| 277 | break; | ||
| 278 | } | ||
| 279 | |||
| 280 | /* Dongles are powered through the modem control lines which | ||
| 281 | * were just set during open. Before resetting, let's wait for | ||
| 282 | * the power to stabilize. This is what some dongle drivers did | ||
| 283 | * in open before, while others didn't - should be safe anyway. | ||
| 284 | */ | ||
| 285 | |||
| 286 | delay = 50; | ||
| 287 | fsm->substate = SIRDEV_STATE_DONGLE_RESET; | ||
| 288 | next_state = SIRDEV_STATE_DONGLE_RESET; | ||
| 289 | |||
| 290 | fsm->param = 9600; | ||
| 291 | |||
| 292 | break; | ||
| 293 | |||
| 294 | case SIRDEV_STATE_DONGLE_CLOSE: | ||
| 295 | /* shouldn't we just treat this as success=? */ | ||
| 296 | if (dev->dongle_drv == NULL) { | ||
| 297 | fsm->result = -EINVAL; | ||
| 298 | next_state = SIRDEV_STATE_ERROR; | ||
| 299 | break; | ||
| 300 | } | ||
| 301 | |||
| 302 | ret = sirdev_put_dongle(dev); | ||
| 303 | if (ret) { | ||
| 304 | fsm->result = ret; | ||
| 305 | next_state = SIRDEV_STATE_ERROR; | ||
| 306 | break; | ||
| 307 | } | ||
| 308 | next_state = SIRDEV_STATE_DONE; | ||
| 309 | break; | ||
| 310 | |||
| 311 | case SIRDEV_STATE_SET_DTR_RTS: | ||
| 312 | ret = sirdev_set_dtr_rts(dev, | ||
| 313 | (fsm->param&0x02) ? TRUE : FALSE, | ||
| 314 | (fsm->param&0x01) ? TRUE : FALSE); | ||
| 315 | next_state = SIRDEV_STATE_DONE; | ||
| 316 | break; | ||
| 317 | |||
| 318 | case SIRDEV_STATE_SET_SPEED: | ||
| 319 | fsm->substate = SIRDEV_STATE_WAIT_XMIT; | ||
| 320 | next_state = SIRDEV_STATE_DONGLE_CHECK; | ||
| 321 | break; | ||
| 322 | |||
| 323 | case SIRDEV_STATE_DONGLE_CHECK: | ||
| 324 | ret = irda_tx_complete_fsm(dev); | ||
| 325 | if (ret < 0) { | ||
| 326 | fsm->result = ret; | ||
| 327 | next_state = SIRDEV_STATE_ERROR; | ||
| 328 | break; | ||
| 329 | } | ||
| 330 | if ((delay=ret) != 0) | ||
| 331 | break; | ||
| 332 | |||
| 333 | if (dev->dongle_drv) { | ||
| 334 | fsm->substate = SIRDEV_STATE_DONGLE_RESET; | ||
| 335 | next_state = SIRDEV_STATE_DONGLE_RESET; | ||
| 336 | } | ||
| 337 | else { | ||
| 338 | dev->speed = fsm->param; | ||
| 339 | next_state = SIRDEV_STATE_PORT_SPEED; | ||
| 340 | } | ||
| 341 | break; | ||
| 342 | |||
| 343 | case SIRDEV_STATE_DONGLE_RESET: | ||
| 344 | if (dev->dongle_drv->reset) { | ||
| 345 | ret = dev->dongle_drv->reset(dev); | ||
| 346 | if (ret < 0) { | ||
| 347 | fsm->result = ret; | ||
| 348 | next_state = SIRDEV_STATE_ERROR; | ||
| 349 | break; | ||
| 350 | } | ||
| 351 | } | ||
| 352 | else | ||
| 353 | ret = 0; | ||
| 354 | if ((delay=ret) == 0) { | ||
| 355 | /* set serial port according to dongle default speed */ | ||
| 356 | if (dev->drv->set_speed) | ||
| 357 | dev->drv->set_speed(dev, dev->speed); | ||
| 358 | fsm->substate = SIRDEV_STATE_DONGLE_SPEED; | ||
| 359 | next_state = SIRDEV_STATE_DONGLE_SPEED; | ||
| 360 | } | ||
| 361 | break; | ||
| 362 | |||
| 363 | case SIRDEV_STATE_DONGLE_SPEED: | ||
| 364 | if (dev->dongle_drv->reset) { | ||
| 365 | ret = dev->dongle_drv->set_speed(dev, fsm->param); | ||
| 366 | if (ret < 0) { | ||
| 367 | fsm->result = ret; | ||
| 368 | next_state = SIRDEV_STATE_ERROR; | ||
| 369 | break; | ||
| 370 | } | ||
| 371 | } | ||
| 372 | else | ||
| 373 | ret = 0; | ||
| 374 | if ((delay=ret) == 0) | ||
| 375 | next_state = SIRDEV_STATE_PORT_SPEED; | ||
| 376 | break; | ||
| 377 | |||
| 378 | case SIRDEV_STATE_PORT_SPEED: | ||
| 379 | /* Finally we are ready to change the serial port speed */ | ||
| 380 | if (dev->drv->set_speed) | ||
| 381 | dev->drv->set_speed(dev, dev->speed); | ||
| 382 | dev->new_speed = 0; | ||
| 383 | next_state = SIRDEV_STATE_DONE; | ||
| 384 | break; | ||
| 385 | |||
| 386 | case SIRDEV_STATE_DONE: | ||
| 387 | /* Signal network layer so it can send more frames */ | ||
| 388 | netif_wake_queue(dev->netdev); | ||
| 389 | next_state = SIRDEV_STATE_COMPLETE; | ||
| 390 | break; | ||
| 391 | |||
| 392 | default: | ||
| 393 | IRDA_ERROR("%s - undefined state\n", __FUNCTION__); | ||
| 394 | fsm->result = -EINVAL; | ||
| 395 | /* fall thru */ | ||
| 396 | |||
| 397 | case SIRDEV_STATE_ERROR: | ||
| 398 | IRDA_ERROR("%s - error: %d\n", __FUNCTION__, fsm->result); | ||
| 399 | |||
| 400 | #if 0 /* don't enable this before we have netdev->tx_timeout to recover */ | ||
| 401 | netif_stop_queue(dev->netdev); | ||
| 402 | #else | ||
| 403 | netif_wake_queue(dev->netdev); | ||
| 404 | #endif | ||
| 405 | /* fall thru */ | ||
| 406 | |||
| 407 | case SIRDEV_STATE_COMPLETE: | ||
| 408 | /* config change finished, so we are not busy any longer */ | ||
| 409 | sirdev_enable_rx(dev); | ||
| 410 | up(&fsm->sem); | ||
| 411 | return; | ||
| 412 | } | ||
| 413 | fsm->state = next_state; | ||
| 414 | } while(!delay); | ||
| 415 | |||
| 416 | irda_queue_delayed_request(&fsm->rq, msecs_to_jiffies(delay)); | ||
| 417 | } | ||
| 418 | |||
| 419 | /* schedule some device configuration task for execution by kIrDAd | ||
| 420 | * on behalf of the above state machine. | ||
| 421 | * can be called from process or interrupt/tasklet context. | ||
| 422 | */ | ||
| 423 | |||
| 424 | int sirdev_schedule_request(struct sir_dev *dev, int initial_state, unsigned param) | ||
| 425 | { | ||
| 426 | struct sir_fsm *fsm = &dev->fsm; | ||
| 427 | int xmit_was_down; | ||
| 428 | |||
| 429 | IRDA_DEBUG(2, "%s - state=0x%04x / param=%u\n", __FUNCTION__, initial_state, param); | ||
| 430 | |||
| 431 | if (down_trylock(&fsm->sem)) { | ||
| 432 | if (in_interrupt() || in_atomic() || irqs_disabled()) { | ||
| 433 | IRDA_DEBUG(1, "%s(), state machine busy!\n", __FUNCTION__); | ||
| 434 | return -EWOULDBLOCK; | ||
| 435 | } else | ||
| 436 | down(&fsm->sem); | ||
| 437 | } | ||
| 438 | |||
| 439 | if (fsm->state == SIRDEV_STATE_DEAD) { | ||
| 440 | /* race with sirdev_close should never happen */ | ||
| 441 | IRDA_ERROR("%s(), instance staled!\n", __FUNCTION__); | ||
| 442 | up(&fsm->sem); | ||
| 443 | return -ESTALE; /* or better EPIPE? */ | ||
| 444 | } | ||
| 445 | |||
| 446 | xmit_was_down = netif_queue_stopped(dev->netdev); | ||
| 447 | netif_stop_queue(dev->netdev); | ||
| 448 | atomic_set(&dev->enable_rx, 0); | ||
| 449 | |||
| 450 | fsm->state = initial_state; | ||
| 451 | fsm->param = param; | ||
| 452 | fsm->result = 0; | ||
| 453 | |||
| 454 | INIT_LIST_HEAD(&fsm->rq.lh_request); | ||
| 455 | fsm->rq.pending = 0; | ||
| 456 | fsm->rq.func = irda_config_fsm; | ||
| 457 | fsm->rq.data = dev; | ||
| 458 | |||
| 459 | if (!irda_queue_request(&fsm->rq)) { /* returns 0 on error! */ | ||
| 460 | atomic_set(&dev->enable_rx, 1); | ||
| 461 | if (!xmit_was_down) | ||
| 462 | netif_wake_queue(dev->netdev); | ||
| 463 | up(&fsm->sem); | ||
| 464 | return -EAGAIN; | ||
| 465 | } | ||
| 466 | return 0; | ||
| 467 | } | ||
| 468 | |||
| 469 | static int __init irda_thread_create(void) | ||
| 470 | { | ||
| 471 | struct completion startup; | ||
| 472 | int pid; | ||
| 473 | |||
| 474 | spin_lock_init(&irda_rq_queue.lock); | ||
| 475 | irda_rq_queue.thread = NULL; | ||
| 476 | INIT_LIST_HEAD(&irda_rq_queue.request_list); | ||
| 477 | init_waitqueue_head(&irda_rq_queue.kick); | ||
| 478 | init_waitqueue_head(&irda_rq_queue.done); | ||
| 479 | atomic_set(&irda_rq_queue.num_pending, 0); | ||
| 480 | |||
| 481 | init_completion(&startup); | ||
| 482 | pid = kernel_thread(irda_thread, &startup, CLONE_FS|CLONE_FILES); | ||
| 483 | if (pid <= 0) | ||
| 484 | return -EAGAIN; | ||
| 485 | else | ||
| 486 | wait_for_completion(&startup); | ||
| 487 | |||
| 488 | return 0; | ||
| 489 | } | ||
| 490 | |||
| 491 | static void __exit irda_thread_join(void) | ||
| 492 | { | ||
| 493 | if (irda_rq_queue.thread) { | ||
| 494 | flush_irda_queue(); | ||
| 495 | init_completion(&irda_rq_queue.exit); | ||
| 496 | irda_rq_queue.thread = NULL; | ||
| 497 | wake_up(&irda_rq_queue.kick); | ||
| 498 | wait_for_completion(&irda_rq_queue.exit); | ||
| 499 | } | ||
| 500 | } | ||
| 501 | |||
| 502 | module_init(irda_thread_create); | ||
| 503 | module_exit(irda_thread_join); | ||
| 504 | |||
| 505 | MODULE_AUTHOR("Martin Diehl <info@mdiehl.de>"); | ||
| 506 | MODULE_DESCRIPTION("IrDA SIR core"); | ||
| 507 | MODULE_LICENSE("GPL"); | ||
| 508 | |||
diff --git a/drivers/net/irda/smsc-ircc2.c b/drivers/net/irda/smsc-ircc2.c index 58f76cefbc83..a4674044bd6f 100644 --- a/drivers/net/irda/smsc-ircc2.c +++ b/drivers/net/irda/smsc-ircc2.c | |||
| @@ -54,6 +54,7 @@ | |||
| 54 | #include <linux/rtnetlink.h> | 54 | #include <linux/rtnetlink.h> |
| 55 | #include <linux/serial_reg.h> | 55 | #include <linux/serial_reg.h> |
| 56 | #include <linux/dma-mapping.h> | 56 | #include <linux/dma-mapping.h> |
| 57 | #include <linux/pnp.h> | ||
| 57 | #include <linux/platform_device.h> | 58 | #include <linux/platform_device.h> |
| 58 | 59 | ||
| 59 | #include <asm/io.h> | 60 | #include <asm/io.h> |
| @@ -358,6 +359,16 @@ static inline void register_bank(int iobase, int bank) | |||
| 358 | iobase + IRCC_MASTER); | 359 | iobase + IRCC_MASTER); |
| 359 | } | 360 | } |
| 360 | 361 | ||
| 362 | #ifdef CONFIG_PNP | ||
| 363 | /* PNP hotplug support */ | ||
| 364 | static const struct pnp_device_id smsc_ircc_pnp_table[] = { | ||
| 365 | { .id = "SMCf010", .driver_data = 0 }, | ||
| 366 | /* and presumably others */ | ||
| 367 | { } | ||
| 368 | }; | ||
| 369 | MODULE_DEVICE_TABLE(pnp, smsc_ircc_pnp_table); | ||
| 370 | #endif | ||
| 371 | |||
| 361 | 372 | ||
| 362 | /******************************************************************************* | 373 | /******************************************************************************* |
| 363 | * | 374 | * |
| @@ -2072,7 +2083,8 @@ static void smsc_ircc_sir_wait_hw_transmitter_finish(struct smsc_ircc_cb *self) | |||
| 2072 | 2083 | ||
| 2073 | /* PROBING | 2084 | /* PROBING |
| 2074 | * | 2085 | * |
| 2075 | * | 2086 | * REVISIT we can be told about the device by PNP, and should use that info |
| 2087 | * instead of probing hardware and creating a platform_device ... | ||
| 2076 | */ | 2088 | */ |
| 2077 | 2089 | ||
| 2078 | static int __init smsc_ircc_look_for_chips(void) | 2090 | static int __init smsc_ircc_look_for_chips(void) |
diff --git a/drivers/net/ixp2000/enp2611.c b/drivers/net/ixp2000/enp2611.c index 6f7dce8eba51..b67f586d7392 100644 --- a/drivers/net/ixp2000/enp2611.c +++ b/drivers/net/ixp2000/enp2611.c | |||
| @@ -149,6 +149,8 @@ static void enp2611_check_link_status(unsigned long __dummy) | |||
| 149 | int status; | 149 | int status; |
| 150 | 150 | ||
| 151 | dev = nds[i]; | 151 | dev = nds[i]; |
| 152 | if (dev == NULL) | ||
| 153 | continue; | ||
| 152 | 154 | ||
| 153 | status = pm3386_is_link_up(i); | 155 | status = pm3386_is_link_up(i); |
| 154 | if (status && !netif_carrier_ok(dev)) { | 156 | if (status && !netif_carrier_ok(dev)) { |
| @@ -191,6 +193,7 @@ static void enp2611_set_port_admin_status(int port, int up) | |||
| 191 | 193 | ||
| 192 | static int __init enp2611_init_module(void) | 194 | static int __init enp2611_init_module(void) |
| 193 | { | 195 | { |
| 196 | int ports; | ||
| 194 | int i; | 197 | int i; |
| 195 | 198 | ||
| 196 | if (!machine_is_enp2611()) | 199 | if (!machine_is_enp2611()) |
| @@ -199,7 +202,8 @@ static int __init enp2611_init_module(void) | |||
| 199 | caleb_reset(); | 202 | caleb_reset(); |
| 200 | pm3386_reset(); | 203 | pm3386_reset(); |
| 201 | 204 | ||
| 202 | for (i = 0; i < 3; i++) { | 205 | ports = pm3386_port_count(); |
| 206 | for (i = 0; i < ports; i++) { | ||
| 203 | nds[i] = ixpdev_alloc(i, sizeof(struct enp2611_ixpdev_priv)); | 207 | nds[i] = ixpdev_alloc(i, sizeof(struct enp2611_ixpdev_priv)); |
| 204 | if (nds[i] == NULL) { | 208 | if (nds[i] == NULL) { |
| 205 | while (--i >= 0) | 209 | while (--i >= 0) |
| @@ -215,9 +219,10 @@ static int __init enp2611_init_module(void) | |||
| 215 | 219 | ||
| 216 | ixp2400_msf_init(&enp2611_msf_parameters); | 220 | ixp2400_msf_init(&enp2611_msf_parameters); |
| 217 | 221 | ||
| 218 | if (ixpdev_init(3, nds, enp2611_set_port_admin_status)) { | 222 | if (ixpdev_init(ports, nds, enp2611_set_port_admin_status)) { |
| 219 | for (i = 0; i < 3; i++) | 223 | for (i = 0; i < ports; i++) |
| 220 | free_netdev(nds[i]); | 224 | if (nds[i]) |
| 225 | free_netdev(nds[i]); | ||
| 221 | return -EINVAL; | 226 | return -EINVAL; |
| 222 | } | 227 | } |
| 223 | 228 | ||
diff --git a/drivers/net/ixp2000/pm3386.c b/drivers/net/ixp2000/pm3386.c index 5c7ab7564053..5224651c9aac 100644 --- a/drivers/net/ixp2000/pm3386.c +++ b/drivers/net/ixp2000/pm3386.c | |||
| @@ -86,40 +86,53 @@ static void pm3386_port_reg_write(int port, int _reg, int spacing, u16 value) | |||
| 86 | pm3386_reg_write(port >> 1, reg, value); | 86 | pm3386_reg_write(port >> 1, reg, value); |
| 87 | } | 87 | } |
| 88 | 88 | ||
| 89 | int pm3386_secondary_present(void) | ||
| 90 | { | ||
| 91 | return pm3386_reg_read(1, 0) == 0x3386; | ||
| 92 | } | ||
| 89 | 93 | ||
| 90 | void pm3386_reset(void) | 94 | void pm3386_reset(void) |
| 91 | { | 95 | { |
| 92 | u8 mac[3][6]; | 96 | u8 mac[3][6]; |
| 97 | int secondary; | ||
| 98 | |||
| 99 | secondary = pm3386_secondary_present(); | ||
| 93 | 100 | ||
| 94 | /* Save programmed MAC addresses. */ | 101 | /* Save programmed MAC addresses. */ |
| 95 | pm3386_get_mac(0, mac[0]); | 102 | pm3386_get_mac(0, mac[0]); |
| 96 | pm3386_get_mac(1, mac[1]); | 103 | pm3386_get_mac(1, mac[1]); |
| 97 | pm3386_get_mac(2, mac[2]); | 104 | if (secondary) |
| 105 | pm3386_get_mac(2, mac[2]); | ||
| 98 | 106 | ||
| 99 | /* Assert analog and digital reset. */ | 107 | /* Assert analog and digital reset. */ |
| 100 | pm3386_reg_write(0, 0x002, 0x0060); | 108 | pm3386_reg_write(0, 0x002, 0x0060); |
| 101 | pm3386_reg_write(1, 0x002, 0x0060); | 109 | if (secondary) |
| 110 | pm3386_reg_write(1, 0x002, 0x0060); | ||
| 102 | mdelay(1); | 111 | mdelay(1); |
| 103 | 112 | ||
| 104 | /* Deassert analog reset. */ | 113 | /* Deassert analog reset. */ |
| 105 | pm3386_reg_write(0, 0x002, 0x0062); | 114 | pm3386_reg_write(0, 0x002, 0x0062); |
| 106 | pm3386_reg_write(1, 0x002, 0x0062); | 115 | if (secondary) |
| 116 | pm3386_reg_write(1, 0x002, 0x0062); | ||
| 107 | mdelay(10); | 117 | mdelay(10); |
| 108 | 118 | ||
| 109 | /* Deassert digital reset. */ | 119 | /* Deassert digital reset. */ |
| 110 | pm3386_reg_write(0, 0x002, 0x0063); | 120 | pm3386_reg_write(0, 0x002, 0x0063); |
| 111 | pm3386_reg_write(1, 0x002, 0x0063); | 121 | if (secondary) |
| 122 | pm3386_reg_write(1, 0x002, 0x0063); | ||
| 112 | mdelay(10); | 123 | mdelay(10); |
| 113 | 124 | ||
| 114 | /* Restore programmed MAC addresses. */ | 125 | /* Restore programmed MAC addresses. */ |
| 115 | pm3386_set_mac(0, mac[0]); | 126 | pm3386_set_mac(0, mac[0]); |
| 116 | pm3386_set_mac(1, mac[1]); | 127 | pm3386_set_mac(1, mac[1]); |
| 117 | pm3386_set_mac(2, mac[2]); | 128 | if (secondary) |
| 129 | pm3386_set_mac(2, mac[2]); | ||
| 118 | 130 | ||
| 119 | /* Disable carrier on all ports. */ | 131 | /* Disable carrier on all ports. */ |
| 120 | pm3386_set_carrier(0, 0); | 132 | pm3386_set_carrier(0, 0); |
| 121 | pm3386_set_carrier(1, 0); | 133 | pm3386_set_carrier(1, 0); |
| 122 | pm3386_set_carrier(2, 0); | 134 | if (secondary) |
| 135 | pm3386_set_carrier(2, 0); | ||
| 123 | } | 136 | } |
| 124 | 137 | ||
| 125 | static u16 swaph(u16 x) | 138 | static u16 swaph(u16 x) |
| @@ -127,6 +140,11 @@ static u16 swaph(u16 x) | |||
| 127 | return ((x << 8) | (x >> 8)) & 0xffff; | 140 | return ((x << 8) | (x >> 8)) & 0xffff; |
| 128 | } | 141 | } |
| 129 | 142 | ||
| 143 | int pm3386_port_count(void) | ||
| 144 | { | ||
| 145 | return 2 + pm3386_secondary_present(); | ||
| 146 | } | ||
| 147 | |||
| 130 | void pm3386_init_port(int port) | 148 | void pm3386_init_port(int port) |
| 131 | { | 149 | { |
| 132 | int pm = port >> 1; | 150 | int pm = port >> 1; |
diff --git a/drivers/net/ixp2000/pm3386.h b/drivers/net/ixp2000/pm3386.h index fe92bb056ac4..cc4183dca911 100644 --- a/drivers/net/ixp2000/pm3386.h +++ b/drivers/net/ixp2000/pm3386.h | |||
| @@ -13,6 +13,7 @@ | |||
| 13 | #define __PM3386_H | 13 | #define __PM3386_H |
| 14 | 14 | ||
| 15 | void pm3386_reset(void); | 15 | void pm3386_reset(void); |
| 16 | int pm3386_port_count(void); | ||
| 16 | void pm3386_init_port(int port); | 17 | void pm3386_init_port(int port); |
| 17 | void pm3386_get_mac(int port, u8 *mac); | 18 | void pm3386_get_mac(int port, u8 *mac); |
| 18 | void pm3386_set_mac(int port, u8 *mac); | 19 | void pm3386_set_mac(int port, u8 *mac); |
diff --git a/drivers/net/ne.c b/drivers/net/ne.c index 93c494bcd18d..b32765215f75 100644 --- a/drivers/net/ne.c +++ b/drivers/net/ne.c | |||
| @@ -139,8 +139,9 @@ bad_clone_list[] __initdata = { | |||
| 139 | 139 | ||
| 140 | #if defined(CONFIG_PLAT_MAPPI) | 140 | #if defined(CONFIG_PLAT_MAPPI) |
| 141 | # define DCR_VAL 0x4b | 141 | # define DCR_VAL 0x4b |
| 142 | #elif defined(CONFIG_PLAT_OAKS32R) | 142 | #elif defined(CONFIG_PLAT_OAKS32R) || \ |
| 143 | # define DCR_VAL 0x48 | 143 | defined(CONFIG_TOSHIBA_RBTX4927) || defined(CONFIG_TOSHIBA_RBTX4938) |
| 144 | # define DCR_VAL 0x48 /* 8-bit mode */ | ||
| 144 | #else | 145 | #else |
| 145 | # define DCR_VAL 0x49 | 146 | # define DCR_VAL 0x49 |
| 146 | #endif | 147 | #endif |
| @@ -396,10 +397,22 @@ static int __init ne_probe1(struct net_device *dev, int ioaddr) | |||
| 396 | /* We must set the 8390 for word mode. */ | 397 | /* We must set the 8390 for word mode. */ |
| 397 | outb_p(DCR_VAL, ioaddr + EN0_DCFG); | 398 | outb_p(DCR_VAL, ioaddr + EN0_DCFG); |
| 398 | start_page = NESM_START_PG; | 399 | start_page = NESM_START_PG; |
| 399 | stop_page = NESM_STOP_PG; | 400 | |
| 401 | /* | ||
| 402 | * Realtek RTL8019AS datasheet says that the PSTOP register | ||
| 403 | * shouldn't exceed 0x60 in 8-bit mode. | ||
| 404 | * This chip can be identified by reading the signature from | ||
| 405 | * the remote byte count registers (otherwise write-only)... | ||
| 406 | */ | ||
| 407 | if ((DCR_VAL & 0x01) == 0 && /* 8-bit mode */ | ||
| 408 | inb(ioaddr + EN0_RCNTLO) == 0x50 && | ||
| 409 | inb(ioaddr + EN0_RCNTHI) == 0x70) | ||
| 410 | stop_page = 0x60; | ||
| 411 | else | ||
| 412 | stop_page = NESM_STOP_PG; | ||
| 400 | } else { | 413 | } else { |
| 401 | start_page = NE1SM_START_PG; | 414 | start_page = NE1SM_START_PG; |
| 402 | stop_page = NE1SM_STOP_PG; | 415 | stop_page = NE1SM_STOP_PG; |
| 403 | } | 416 | } |
| 404 | 417 | ||
| 405 | #if defined(CONFIG_PLAT_MAPPI) || defined(CONFIG_PLAT_OAKS32R) | 418 | #if defined(CONFIG_PLAT_MAPPI) || defined(CONFIG_PLAT_OAKS32R) |
| @@ -509,15 +522,9 @@ static int __init ne_probe1(struct net_device *dev, int ioaddr) | |||
| 509 | ei_status.name = name; | 522 | ei_status.name = name; |
| 510 | ei_status.tx_start_page = start_page; | 523 | ei_status.tx_start_page = start_page; |
| 511 | ei_status.stop_page = stop_page; | 524 | ei_status.stop_page = stop_page; |
| 512 | #if defined(CONFIG_TOSHIBA_RBTX4927) || defined(CONFIG_TOSHIBA_RBTX4938) | ||
| 513 | wordlength = 1; | ||
| 514 | #endif | ||
| 515 | 525 | ||
| 516 | #ifdef CONFIG_PLAT_OAKS32R | 526 | /* Use 16-bit mode only if this wasn't overridden by DCR_VAL */ |
| 517 | ei_status.word16 = 0; | 527 | ei_status.word16 = (wordlength == 2 && (DCR_VAL & 0x01)); |
| 518 | #else | ||
| 519 | ei_status.word16 = (wordlength == 2); | ||
| 520 | #endif | ||
| 521 | 528 | ||
| 522 | ei_status.rx_start_page = start_page + TX_PAGES; | 529 | ei_status.rx_start_page = start_page + TX_PAGES; |
| 523 | #ifdef PACKETBUF_MEMSIZE | 530 | #ifdef PACKETBUF_MEMSIZE |
diff --git a/drivers/net/pcmcia/axnet_cs.c b/drivers/net/pcmcia/axnet_cs.c index 448a09488529..2ea66aca648b 100644 --- a/drivers/net/pcmcia/axnet_cs.c +++ b/drivers/net/pcmcia/axnet_cs.c | |||
| @@ -1691,17 +1691,6 @@ static void do_set_multicast_list(struct net_device *dev) | |||
| 1691 | memset(ei_local->mcfilter, 0xFF, 8); | 1691 | memset(ei_local->mcfilter, 0xFF, 8); |
| 1692 | } | 1692 | } |
| 1693 | 1693 | ||
| 1694 | /* | ||
| 1695 | * DP8390 manuals don't specify any magic sequence for altering | ||
| 1696 | * the multicast regs on an already running card. To be safe, we | ||
| 1697 | * ensure multicast mode is off prior to loading up the new hash | ||
| 1698 | * table. If this proves to be not enough, we can always resort | ||
| 1699 | * to stopping the NIC, loading the table and then restarting. | ||
| 1700 | */ | ||
| 1701 | |||
| 1702 | if (netif_running(dev)) | ||
| 1703 | outb_p(E8390_RXCONFIG, e8390_base + EN0_RXCR); | ||
| 1704 | |||
| 1705 | outb_p(E8390_NODMA + E8390_PAGE1, e8390_base + E8390_CMD); | 1694 | outb_p(E8390_NODMA + E8390_PAGE1, e8390_base + E8390_CMD); |
| 1706 | for(i = 0; i < 8; i++) | 1695 | for(i = 0; i < 8; i++) |
| 1707 | { | 1696 | { |
| @@ -1715,6 +1704,8 @@ static void do_set_multicast_list(struct net_device *dev) | |||
| 1715 | outb_p(E8390_RXCONFIG | 0x48, e8390_base + EN0_RXCR); | 1704 | outb_p(E8390_RXCONFIG | 0x48, e8390_base + EN0_RXCR); |
| 1716 | else | 1705 | else |
| 1717 | outb_p(E8390_RXCONFIG | 0x40, e8390_base + EN0_RXCR); | 1706 | outb_p(E8390_RXCONFIG | 0x40, e8390_base + EN0_RXCR); |
| 1707 | |||
| 1708 | outb_p(E8390_NODMA+E8390_PAGE0+E8390_START, e8390_base+E8390_CMD); | ||
| 1718 | } | 1709 | } |
| 1719 | 1710 | ||
| 1720 | /* | 1711 | /* |
diff --git a/drivers/net/phy/mdio_bus.c b/drivers/net/phy/mdio_bus.c index 459443b572ce..1b236bdf6b92 100644 --- a/drivers/net/phy/mdio_bus.c +++ b/drivers/net/phy/mdio_bus.c | |||
| @@ -60,8 +60,10 @@ int mdiobus_register(struct mii_bus *bus) | |||
| 60 | for (i = 0; i < PHY_MAX_ADDR; i++) { | 60 | for (i = 0; i < PHY_MAX_ADDR; i++) { |
| 61 | struct phy_device *phydev; | 61 | struct phy_device *phydev; |
| 62 | 62 | ||
| 63 | if (bus->phy_mask & (1 << i)) | 63 | if (bus->phy_mask & (1 << i)) { |
| 64 | bus->phy_map[i] = NULL; | ||
| 64 | continue; | 65 | continue; |
| 66 | } | ||
| 65 | 67 | ||
| 66 | phydev = get_phy_device(bus, i); | 68 | phydev = get_phy_device(bus, i); |
| 67 | 69 | ||
diff --git a/drivers/net/sis900.c b/drivers/net/sis900.c index b82191d2bee1..f5a3bf4d959a 100644 --- a/drivers/net/sis900.c +++ b/drivers/net/sis900.c | |||
| @@ -127,6 +127,7 @@ static const struct mii_chip_info { | |||
| 127 | } mii_chip_table[] = { | 127 | } mii_chip_table[] = { |
| 128 | { "SiS 900 Internal MII PHY", 0x001d, 0x8000, LAN }, | 128 | { "SiS 900 Internal MII PHY", 0x001d, 0x8000, LAN }, |
| 129 | { "SiS 7014 Physical Layer Solution", 0x0016, 0xf830, LAN }, | 129 | { "SiS 7014 Physical Layer Solution", 0x0016, 0xf830, LAN }, |
| 130 | { "SiS 900 on Foxconn 661 7MI", 0x0143, 0xBC70, LAN }, | ||
| 130 | { "Altimata AC101LF PHY", 0x0022, 0x5520, LAN }, | 131 | { "Altimata AC101LF PHY", 0x0022, 0x5520, LAN }, |
| 131 | { "ADM 7001 LAN PHY", 0x002e, 0xcc60, LAN }, | 132 | { "ADM 7001 LAN PHY", 0x002e, 0xcc60, LAN }, |
| 132 | { "AMD 79C901 10BASE-T PHY", 0x0000, 0x6B70, LAN }, | 133 | { "AMD 79C901 10BASE-T PHY", 0x0000, 0x6B70, LAN }, |
diff --git a/drivers/net/skge.c b/drivers/net/skge.c index a70c2b0cc104..5ca5a1b546a1 100644 --- a/drivers/net/skge.c +++ b/drivers/net/skge.c | |||
| @@ -78,8 +78,7 @@ static const struct pci_device_id skge_id_table[] = { | |||
| 78 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, PCI_DEVICE_ID_SYSKONNECT_GE) }, | 78 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, PCI_DEVICE_ID_SYSKONNECT_GE) }, |
| 79 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, PCI_DEVICE_ID_SYSKONNECT_YU) }, | 79 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, PCI_DEVICE_ID_SYSKONNECT_YU) }, |
| 80 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, PCI_DEVICE_ID_DLINK_DGE510T), }, | 80 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, PCI_DEVICE_ID_DLINK_DGE510T), }, |
| 81 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4b00) }, | 81 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4b01) }, /* DGE-530T */ |
| 82 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4b01) }, | ||
| 83 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4320) }, | 82 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4320) }, |
| 84 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x5005) }, /* Belkin */ | 83 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x5005) }, /* Belkin */ |
| 85 | { PCI_DEVICE(PCI_VENDOR_ID_CNET, PCI_DEVICE_ID_CNET_GIGACARD) }, | 84 | { PCI_DEVICE(PCI_VENDOR_ID_CNET, PCI_DEVICE_ID_CNET_GIGACARD) }, |
| @@ -402,7 +401,7 @@ static int skge_set_ring_param(struct net_device *dev, | |||
| 402 | int err; | 401 | int err; |
| 403 | 402 | ||
| 404 | if (p->rx_pending == 0 || p->rx_pending > MAX_RX_RING_SIZE || | 403 | if (p->rx_pending == 0 || p->rx_pending > MAX_RX_RING_SIZE || |
| 405 | p->tx_pending == 0 || p->tx_pending > MAX_TX_RING_SIZE) | 404 | p->tx_pending < MAX_SKB_FRAGS+1 || p->tx_pending > MAX_TX_RING_SIZE) |
| 406 | return -EINVAL; | 405 | return -EINVAL; |
| 407 | 406 | ||
| 408 | skge->rx_ring.count = p->rx_pending; | 407 | skge->rx_ring.count = p->rx_pending; |
| @@ -2717,8 +2716,7 @@ static int skge_poll(struct net_device *dev, int *budget) | |||
| 2717 | if (control & BMU_OWN) | 2716 | if (control & BMU_OWN) |
| 2718 | break; | 2717 | break; |
| 2719 | 2718 | ||
| 2720 | skb = skge_rx_get(skge, e, control, rd->status, | 2719 | skb = skge_rx_get(skge, e, control, rd->status, rd->csum2); |
| 2721 | le16_to_cpu(rd->csum2)); | ||
| 2722 | if (likely(skb)) { | 2720 | if (likely(skb)) { |
| 2723 | dev->last_rx = jiffies; | 2721 | dev->last_rx = jiffies; |
| 2724 | netif_receive_skb(skb); | 2722 | netif_receive_skb(skb); |
diff --git a/drivers/net/sky2.c b/drivers/net/sky2.c index 227df9876a2c..60779ebf2ff6 100644 --- a/drivers/net/sky2.c +++ b/drivers/net/sky2.c | |||
| @@ -51,7 +51,7 @@ | |||
| 51 | #include "sky2.h" | 51 | #include "sky2.h" |
| 52 | 52 | ||
| 53 | #define DRV_NAME "sky2" | 53 | #define DRV_NAME "sky2" |
| 54 | #define DRV_VERSION "1.2" | 54 | #define DRV_VERSION "1.4" |
| 55 | #define PFX DRV_NAME " " | 55 | #define PFX DRV_NAME " " |
| 56 | 56 | ||
| 57 | /* | 57 | /* |
| @@ -79,6 +79,8 @@ | |||
| 79 | #define NAPI_WEIGHT 64 | 79 | #define NAPI_WEIGHT 64 |
| 80 | #define PHY_RETRIES 1000 | 80 | #define PHY_RETRIES 1000 |
| 81 | 81 | ||
| 82 | #define RING_NEXT(x,s) (((x)+1) & ((s)-1)) | ||
| 83 | |||
| 82 | static const u32 default_msg = | 84 | static const u32 default_msg = |
| 83 | NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK | 85 | NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK |
| 84 | | NETIF_MSG_TIMER | NETIF_MSG_TX_ERR | NETIF_MSG_RX_ERR | 86 | | NETIF_MSG_TIMER | NETIF_MSG_TX_ERR | NETIF_MSG_RX_ERR |
| @@ -96,9 +98,14 @@ static int disable_msi = 0; | |||
| 96 | module_param(disable_msi, int, 0); | 98 | module_param(disable_msi, int, 0); |
| 97 | MODULE_PARM_DESC(disable_msi, "Disable Message Signaled Interrupt (MSI)"); | 99 | MODULE_PARM_DESC(disable_msi, "Disable Message Signaled Interrupt (MSI)"); |
| 98 | 100 | ||
| 101 | static int idle_timeout = 100; | ||
| 102 | module_param(idle_timeout, int, 0); | ||
| 103 | MODULE_PARM_DESC(idle_timeout, "Idle timeout workaround for lost interrupts (ms)"); | ||
| 104 | |||
| 99 | static const struct pci_device_id sky2_id_table[] = { | 105 | static const struct pci_device_id sky2_id_table[] = { |
| 100 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, 0x9000) }, | 106 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, 0x9000) }, |
| 101 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, 0x9E00) }, | 107 | { PCI_DEVICE(PCI_VENDOR_ID_SYSKONNECT, 0x9E00) }, |
| 108 | { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4b00) }, /* DGE-560T */ | ||
| 102 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4340) }, | 109 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4340) }, |
| 103 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4341) }, | 110 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4341) }, |
| 104 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4342) }, | 111 | { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, 0x4342) }, |
| @@ -122,6 +129,7 @@ MODULE_DEVICE_TABLE(pci, sky2_id_table); | |||
| 122 | /* Avoid conditionals by using array */ | 129 | /* Avoid conditionals by using array */ |
| 123 | static const unsigned txqaddr[] = { Q_XA1, Q_XA2 }; | 130 | static const unsigned txqaddr[] = { Q_XA1, Q_XA2 }; |
| 124 | static const unsigned rxqaddr[] = { Q_R1, Q_R2 }; | 131 | static const unsigned rxqaddr[] = { Q_R1, Q_R2 }; |
| 132 | static const u32 portirq_msk[] = { Y2_IS_PORT_1, Y2_IS_PORT_2 }; | ||
| 125 | 133 | ||
| 126 | /* This driver supports yukon2 chipset only */ | 134 | /* This driver supports yukon2 chipset only */ |
| 127 | static const char *yukon2_name[] = { | 135 | static const char *yukon2_name[] = { |
| @@ -228,6 +236,7 @@ static int sky2_set_power_state(struct sky2_hw *hw, pci_power_t state) | |||
| 228 | } | 236 | } |
| 229 | 237 | ||
| 230 | if (hw->chip_id == CHIP_ID_YUKON_EC_U) { | 238 | if (hw->chip_id == CHIP_ID_YUKON_EC_U) { |
| 239 | sky2_write16(hw, B0_CTST, Y2_HW_WOL_ON); | ||
| 231 | sky2_pci_write32(hw, PCI_DEV_REG3, 0); | 240 | sky2_pci_write32(hw, PCI_DEV_REG3, 0); |
| 232 | reg1 = sky2_pci_read32(hw, PCI_DEV_REG4); | 241 | reg1 = sky2_pci_read32(hw, PCI_DEV_REG4); |
| 233 | reg1 &= P_ASPM_CONTROL_MSK; | 242 | reg1 &= P_ASPM_CONTROL_MSK; |
| @@ -298,7 +307,8 @@ static void sky2_phy_init(struct sky2_hw *hw, unsigned port) | |||
| 298 | struct sky2_port *sky2 = netdev_priv(hw->dev[port]); | 307 | struct sky2_port *sky2 = netdev_priv(hw->dev[port]); |
| 299 | u16 ctrl, ct1000, adv, pg, ledctrl, ledover; | 308 | u16 ctrl, ct1000, adv, pg, ledctrl, ledover; |
| 300 | 309 | ||
| 301 | if (sky2->autoneg == AUTONEG_ENABLE && hw->chip_id != CHIP_ID_YUKON_XL) { | 310 | if (sky2->autoneg == AUTONEG_ENABLE && |
| 311 | !(hw->chip_id == CHIP_ID_YUKON_XL || hw->chip_id == CHIP_ID_YUKON_EC_U)) { | ||
| 302 | u16 ectrl = gm_phy_read(hw, port, PHY_MARV_EXT_CTRL); | 312 | u16 ectrl = gm_phy_read(hw, port, PHY_MARV_EXT_CTRL); |
| 303 | 313 | ||
| 304 | ectrl &= ~(PHY_M_EC_M_DSC_MSK | PHY_M_EC_S_DSC_MSK | | 314 | ectrl &= ~(PHY_M_EC_M_DSC_MSK | PHY_M_EC_S_DSC_MSK | |
| @@ -326,7 +336,7 @@ static void sky2_phy_init(struct sky2_hw *hw, unsigned port) | |||
| 326 | ctrl |= PHY_M_PC_MDI_XMODE(PHY_M_PC_ENA_AUTO); | 336 | ctrl |= PHY_M_PC_MDI_XMODE(PHY_M_PC_ENA_AUTO); |
| 327 | 337 | ||
| 328 | if (sky2->autoneg == AUTONEG_ENABLE && | 338 | if (sky2->autoneg == AUTONEG_ENABLE && |
| 329 | hw->chip_id == CHIP_ID_YUKON_XL) { | 339 | (hw->chip_id == CHIP_ID_YUKON_XL || hw->chip_id == CHIP_ID_YUKON_EC_U)) { |
| 330 | ctrl &= ~PHY_M_PC_DSC_MSK; | 340 | ctrl &= ~PHY_M_PC_DSC_MSK; |
| 331 | ctrl |= PHY_M_PC_DSC(2) | PHY_M_PC_DOWN_S_ENA; | 341 | ctrl |= PHY_M_PC_DSC(2) | PHY_M_PC_DOWN_S_ENA; |
| 332 | } | 342 | } |
| @@ -442,10 +452,11 @@ static void sky2_phy_init(struct sky2_hw *hw, unsigned port) | |||
| 442 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 3); | 452 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 3); |
| 443 | 453 | ||
| 444 | /* set LED Function Control register */ | 454 | /* set LED Function Control register */ |
| 445 | gm_phy_write(hw, port, PHY_MARV_PHY_CTRL, (PHY_M_LEDC_LOS_CTRL(1) | /* LINK/ACT */ | 455 | gm_phy_write(hw, port, PHY_MARV_PHY_CTRL, |
| 446 | PHY_M_LEDC_INIT_CTRL(7) | /* 10 Mbps */ | 456 | (PHY_M_LEDC_LOS_CTRL(1) | /* LINK/ACT */ |
| 447 | PHY_M_LEDC_STA1_CTRL(7) | /* 100 Mbps */ | 457 | PHY_M_LEDC_INIT_CTRL(7) | /* 10 Mbps */ |
| 448 | PHY_M_LEDC_STA0_CTRL(7))); /* 1000 Mbps */ | 458 | PHY_M_LEDC_STA1_CTRL(7) | /* 100 Mbps */ |
| 459 | PHY_M_LEDC_STA0_CTRL(7))); /* 1000 Mbps */ | ||
| 449 | 460 | ||
| 450 | /* set Polarity Control register */ | 461 | /* set Polarity Control register */ |
| 451 | gm_phy_write(hw, port, PHY_MARV_PHY_STAT, | 462 | gm_phy_write(hw, port, PHY_MARV_PHY_STAT, |
| @@ -459,6 +470,25 @@ static void sky2_phy_init(struct sky2_hw *hw, unsigned port) | |||
| 459 | /* restore page register */ | 470 | /* restore page register */ |
| 460 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); | 471 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); |
| 461 | break; | 472 | break; |
| 473 | case CHIP_ID_YUKON_EC_U: | ||
| 474 | pg = gm_phy_read(hw, port, PHY_MARV_EXT_ADR); | ||
| 475 | |||
| 476 | /* select page 3 to access LED control register */ | ||
| 477 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 3); | ||
| 478 | |||
| 479 | /* set LED Function Control register */ | ||
| 480 | gm_phy_write(hw, port, PHY_MARV_PHY_CTRL, | ||
| 481 | (PHY_M_LEDC_LOS_CTRL(1) | /* LINK/ACT */ | ||
| 482 | PHY_M_LEDC_INIT_CTRL(8) | /* 10 Mbps */ | ||
| 483 | PHY_M_LEDC_STA1_CTRL(7) | /* 100 Mbps */ | ||
| 484 | PHY_M_LEDC_STA0_CTRL(7)));/* 1000 Mbps */ | ||
| 485 | |||
| 486 | /* set Blink Rate in LED Timer Control Register */ | ||
| 487 | gm_phy_write(hw, port, PHY_MARV_INT_MASK, | ||
| 488 | ledctrl | PHY_M_LED_BLINK_RT(BLINK_84MS)); | ||
| 489 | /* restore page register */ | ||
| 490 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); | ||
| 491 | break; | ||
| 462 | 492 | ||
| 463 | default: | 493 | default: |
| 464 | /* set Tx LED (LED_TX) to blink mode on Rx OR Tx activity */ | 494 | /* set Tx LED (LED_TX) to blink mode on Rx OR Tx activity */ |
| @@ -467,19 +497,21 @@ static void sky2_phy_init(struct sky2_hw *hw, unsigned port) | |||
| 467 | ledover |= PHY_M_LED_MO_RX(MO_LED_OFF); | 497 | ledover |= PHY_M_LED_MO_RX(MO_LED_OFF); |
| 468 | } | 498 | } |
| 469 | 499 | ||
| 470 | if (hw->chip_id == CHIP_ID_YUKON_EC_U && hw->chip_rev >= 2) { | 500 | if (hw->chip_id == CHIP_ID_YUKON_EC_U && hw->chip_rev == CHIP_REV_YU_EC_A1) { |
| 471 | /* apply fixes in PHY AFE */ | 501 | /* apply fixes in PHY AFE */ |
| 472 | gm_phy_write(hw, port, 22, 255); | 502 | pg = gm_phy_read(hw, port, PHY_MARV_EXT_ADR); |
| 503 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 255); | ||
| 504 | |||
| 473 | /* increase differential signal amplitude in 10BASE-T */ | 505 | /* increase differential signal amplitude in 10BASE-T */ |
| 474 | gm_phy_write(hw, port, 24, 0xaa99); | 506 | gm_phy_write(hw, port, 0x18, 0xaa99); |
| 475 | gm_phy_write(hw, port, 23, 0x2011); | 507 | gm_phy_write(hw, port, 0x17, 0x2011); |
| 476 | 508 | ||
| 477 | /* fix for IEEE A/B Symmetry failure in 1000BASE-T */ | 509 | /* fix for IEEE A/B Symmetry failure in 1000BASE-T */ |
| 478 | gm_phy_write(hw, port, 24, 0xa204); | 510 | gm_phy_write(hw, port, 0x18, 0xa204); |
| 479 | gm_phy_write(hw, port, 23, 0x2002); | 511 | gm_phy_write(hw, port, 0x17, 0x2002); |
| 480 | 512 | ||
| 481 | /* set page register to 0 */ | 513 | /* set page register to 0 */ |
| 482 | gm_phy_write(hw, port, 22, 0); | 514 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); |
| 483 | } else { | 515 | } else { |
| 484 | gm_phy_write(hw, port, PHY_MARV_LED_CTRL, ledctrl); | 516 | gm_phy_write(hw, port, PHY_MARV_LED_CTRL, ledctrl); |
| 485 | 517 | ||
| @@ -553,6 +585,11 @@ static void sky2_mac_init(struct sky2_hw *hw, unsigned port) | |||
| 553 | 585 | ||
| 554 | if (sky2->duplex == DUPLEX_FULL) | 586 | if (sky2->duplex == DUPLEX_FULL) |
| 555 | reg |= GM_GPCR_DUP_FULL; | 587 | reg |= GM_GPCR_DUP_FULL; |
| 588 | |||
| 589 | /* turn off pause in 10/100mbps half duplex */ | ||
| 590 | else if (sky2->speed != SPEED_1000 && | ||
| 591 | hw->chip_id != CHIP_ID_YUKON_EC_U) | ||
| 592 | sky2->tx_pause = sky2->rx_pause = 0; | ||
| 556 | } else | 593 | } else |
| 557 | reg = GM_GPCR_SPEED_1000 | GM_GPCR_SPEED_100 | GM_GPCR_DUP_FULL; | 594 | reg = GM_GPCR_SPEED_1000 | GM_GPCR_SPEED_100 | GM_GPCR_DUP_FULL; |
| 558 | 595 | ||
| @@ -719,7 +756,7 @@ static inline struct sky2_tx_le *get_tx_le(struct sky2_port *sky2) | |||
| 719 | { | 756 | { |
| 720 | struct sky2_tx_le *le = sky2->tx_le + sky2->tx_prod; | 757 | struct sky2_tx_le *le = sky2->tx_le + sky2->tx_prod; |
| 721 | 758 | ||
| 722 | sky2->tx_prod = (sky2->tx_prod + 1) % TX_RING_SIZE; | 759 | sky2->tx_prod = RING_NEXT(sky2->tx_prod, TX_RING_SIZE); |
| 723 | return le; | 760 | return le; |
| 724 | } | 761 | } |
| 725 | 762 | ||
| @@ -735,7 +772,7 @@ static inline void sky2_put_idx(struct sky2_hw *hw, unsigned q, u16 idx) | |||
| 735 | static inline struct sky2_rx_le *sky2_next_rx(struct sky2_port *sky2) | 772 | static inline struct sky2_rx_le *sky2_next_rx(struct sky2_port *sky2) |
| 736 | { | 773 | { |
| 737 | struct sky2_rx_le *le = sky2->rx_le + sky2->rx_put; | 774 | struct sky2_rx_le *le = sky2->rx_le + sky2->rx_put; |
| 738 | sky2->rx_put = (sky2->rx_put + 1) % RX_LE_SIZE; | 775 | sky2->rx_put = RING_NEXT(sky2->rx_put, RX_LE_SIZE); |
| 739 | return le; | 776 | return le; |
| 740 | } | 777 | } |
| 741 | 778 | ||
| @@ -985,7 +1022,25 @@ static int sky2_up(struct net_device *dev) | |||
| 985 | struct sky2_hw *hw = sky2->hw; | 1022 | struct sky2_hw *hw = sky2->hw; |
| 986 | unsigned port = sky2->port; | 1023 | unsigned port = sky2->port; |
| 987 | u32 ramsize, rxspace, imask; | 1024 | u32 ramsize, rxspace, imask; |
| 988 | int err = -ENOMEM; | 1025 | int cap, err = -ENOMEM; |
| 1026 | struct net_device *otherdev = hw->dev[sky2->port^1]; | ||
| 1027 | |||
| 1028 | /* | ||
| 1029 | * On dual port PCI-X card, there is an problem where status | ||
| 1030 | * can be received out of order due to split transactions | ||
| 1031 | */ | ||
| 1032 | if (otherdev && netif_running(otherdev) && | ||
| 1033 | (cap = pci_find_capability(hw->pdev, PCI_CAP_ID_PCIX))) { | ||
| 1034 | struct sky2_port *osky2 = netdev_priv(otherdev); | ||
| 1035 | u16 cmd; | ||
| 1036 | |||
| 1037 | cmd = sky2_pci_read16(hw, cap + PCI_X_CMD); | ||
| 1038 | cmd &= ~PCI_X_CMD_MAX_SPLIT; | ||
| 1039 | sky2_pci_write16(hw, cap + PCI_X_CMD, cmd); | ||
| 1040 | |||
| 1041 | sky2->rx_csum = 0; | ||
| 1042 | osky2->rx_csum = 0; | ||
| 1043 | } | ||
| 989 | 1044 | ||
| 990 | if (netif_msg_ifup(sky2)) | 1045 | if (netif_msg_ifup(sky2)) |
| 991 | printk(KERN_INFO PFX "%s: enabling interface\n", dev->name); | 1046 | printk(KERN_INFO PFX "%s: enabling interface\n", dev->name); |
| @@ -1050,7 +1105,7 @@ static int sky2_up(struct net_device *dev) | |||
| 1050 | 1105 | ||
| 1051 | /* Enable interrupts from phy/mac for port */ | 1106 | /* Enable interrupts from phy/mac for port */ |
| 1052 | imask = sky2_read32(hw, B0_IMSK); | 1107 | imask = sky2_read32(hw, B0_IMSK); |
| 1053 | imask |= (port == 0) ? Y2_IS_PORT_1 : Y2_IS_PORT_2; | 1108 | imask |= portirq_msk[port]; |
| 1054 | sky2_write32(hw, B0_IMSK, imask); | 1109 | sky2_write32(hw, B0_IMSK, imask); |
| 1055 | 1110 | ||
| 1056 | return 0; | 1111 | return 0; |
| @@ -1078,7 +1133,7 @@ err_out: | |||
| 1078 | /* Modular subtraction in ring */ | 1133 | /* Modular subtraction in ring */ |
| 1079 | static inline int tx_dist(unsigned tail, unsigned head) | 1134 | static inline int tx_dist(unsigned tail, unsigned head) |
| 1080 | { | 1135 | { |
| 1081 | return (head - tail) % TX_RING_SIZE; | 1136 | return (head - tail) & (TX_RING_SIZE - 1); |
| 1082 | } | 1137 | } |
| 1083 | 1138 | ||
| 1084 | /* Number of list elements available for next tx */ | 1139 | /* Number of list elements available for next tx */ |
| @@ -1255,7 +1310,7 @@ static int sky2_xmit_frame(struct sk_buff *skb, struct net_device *dev) | |||
| 1255 | le->opcode = OP_BUFFER | HW_OWNER; | 1310 | le->opcode = OP_BUFFER | HW_OWNER; |
| 1256 | 1311 | ||
| 1257 | fre = sky2->tx_ring | 1312 | fre = sky2->tx_ring |
| 1258 | + ((re - sky2->tx_ring) + i + 1) % TX_RING_SIZE; | 1313 | + RING_NEXT((re - sky2->tx_ring) + i, TX_RING_SIZE); |
| 1259 | pci_unmap_addr_set(fre, mapaddr, mapping); | 1314 | pci_unmap_addr_set(fre, mapaddr, mapping); |
| 1260 | } | 1315 | } |
| 1261 | 1316 | ||
| @@ -1315,7 +1370,7 @@ static void sky2_tx_complete(struct sky2_port *sky2, u16 done) | |||
| 1315 | 1370 | ||
| 1316 | for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { | 1371 | for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { |
| 1317 | struct tx_ring_info *fre; | 1372 | struct tx_ring_info *fre; |
| 1318 | fre = sky2->tx_ring + (put + i + 1) % TX_RING_SIZE; | 1373 | fre = sky2->tx_ring + RING_NEXT(put + i, TX_RING_SIZE); |
| 1319 | pci_unmap_page(pdev, pci_unmap_addr(fre, mapaddr), | 1374 | pci_unmap_page(pdev, pci_unmap_addr(fre, mapaddr), |
| 1320 | skb_shinfo(skb)->frags[i].size, | 1375 | skb_shinfo(skb)->frags[i].size, |
| 1321 | PCI_DMA_TODEVICE); | 1376 | PCI_DMA_TODEVICE); |
| @@ -1401,7 +1456,7 @@ static int sky2_down(struct net_device *dev) | |||
| 1401 | 1456 | ||
| 1402 | /* Disable port IRQ */ | 1457 | /* Disable port IRQ */ |
| 1403 | imask = sky2_read32(hw, B0_IMSK); | 1458 | imask = sky2_read32(hw, B0_IMSK); |
| 1404 | imask &= ~(sky2->port == 0) ? Y2_IS_PORT_1 : Y2_IS_PORT_2; | 1459 | imask &= ~portirq_msk[port]; |
| 1405 | sky2_write32(hw, B0_IMSK, imask); | 1460 | sky2_write32(hw, B0_IMSK, imask); |
| 1406 | 1461 | ||
| 1407 | /* turn off LED's */ | 1462 | /* turn off LED's */ |
| @@ -1498,17 +1553,26 @@ static void sky2_link_up(struct sky2_port *sky2) | |||
| 1498 | sky2_write8(hw, SK_REG(port, LNK_LED_REG), | 1553 | sky2_write8(hw, SK_REG(port, LNK_LED_REG), |
| 1499 | LINKLED_ON | LINKLED_BLINK_OFF | LINKLED_LINKSYNC_OFF); | 1554 | LINKLED_ON | LINKLED_BLINK_OFF | LINKLED_LINKSYNC_OFF); |
| 1500 | 1555 | ||
| 1501 | if (hw->chip_id == CHIP_ID_YUKON_XL) { | 1556 | if (hw->chip_id == CHIP_ID_YUKON_XL || hw->chip_id == CHIP_ID_YUKON_EC_U) { |
| 1502 | u16 pg = gm_phy_read(hw, port, PHY_MARV_EXT_ADR); | 1557 | u16 pg = gm_phy_read(hw, port, PHY_MARV_EXT_ADR); |
| 1558 | u16 led = PHY_M_LEDC_LOS_CTRL(1); /* link active */ | ||
| 1559 | |||
| 1560 | switch(sky2->speed) { | ||
| 1561 | case SPEED_10: | ||
| 1562 | led |= PHY_M_LEDC_INIT_CTRL(7); | ||
| 1563 | break; | ||
| 1564 | |||
| 1565 | case SPEED_100: | ||
| 1566 | led |= PHY_M_LEDC_STA1_CTRL(7); | ||
| 1567 | break; | ||
| 1568 | |||
| 1569 | case SPEED_1000: | ||
| 1570 | led |= PHY_M_LEDC_STA0_CTRL(7); | ||
| 1571 | break; | ||
| 1572 | } | ||
| 1503 | 1573 | ||
| 1504 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 3); | 1574 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, 3); |
| 1505 | gm_phy_write(hw, port, PHY_MARV_PHY_CTRL, PHY_M_LEDC_LOS_CTRL(1) | /* LINK/ACT */ | 1575 | gm_phy_write(hw, port, PHY_MARV_PHY_CTRL, led); |
| 1506 | PHY_M_LEDC_INIT_CTRL(sky2->speed == | ||
| 1507 | SPEED_10 ? 7 : 0) | | ||
| 1508 | PHY_M_LEDC_STA1_CTRL(sky2->speed == | ||
| 1509 | SPEED_100 ? 7 : 0) | | ||
| 1510 | PHY_M_LEDC_STA0_CTRL(sky2->speed == | ||
| 1511 | SPEED_1000 ? 7 : 0)); | ||
| 1512 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); | 1576 | gm_phy_write(hw, port, PHY_MARV_EXT_ADR, pg); |
| 1513 | } | 1577 | } |
| 1514 | 1578 | ||
| @@ -1583,7 +1647,7 @@ static int sky2_autoneg_done(struct sky2_port *sky2, u16 aux) | |||
| 1583 | sky2->speed = sky2_phy_speed(hw, aux); | 1647 | sky2->speed = sky2_phy_speed(hw, aux); |
| 1584 | 1648 | ||
| 1585 | /* Pause bits are offset (9..8) */ | 1649 | /* Pause bits are offset (9..8) */ |
| 1586 | if (hw->chip_id == CHIP_ID_YUKON_XL) | 1650 | if (hw->chip_id == CHIP_ID_YUKON_XL || hw->chip_id == CHIP_ID_YUKON_EC_U) |
| 1587 | aux >>= 6; | 1651 | aux >>= 6; |
| 1588 | 1652 | ||
| 1589 | sky2->rx_pause = (aux & PHY_M_PS_RX_P_EN) != 0; | 1653 | sky2->rx_pause = (aux & PHY_M_PS_RX_P_EN) != 0; |
| @@ -1855,39 +1919,38 @@ static inline void sky2_tx_done(struct net_device *dev, u16 last) | |||
| 1855 | } | 1919 | } |
| 1856 | } | 1920 | } |
| 1857 | 1921 | ||
| 1922 | /* Is status ring empty or is there more to do? */ | ||
| 1923 | static inline int sky2_more_work(const struct sky2_hw *hw) | ||
| 1924 | { | ||
| 1925 | return (hw->st_idx != sky2_read16(hw, STAT_PUT_IDX)); | ||
| 1926 | } | ||
| 1927 | |||
| 1858 | /* Process status response ring */ | 1928 | /* Process status response ring */ |
| 1859 | static int sky2_status_intr(struct sky2_hw *hw, int to_do) | 1929 | static int sky2_status_intr(struct sky2_hw *hw, int to_do) |
| 1860 | { | 1930 | { |
| 1861 | int work_done = 0; | 1931 | int work_done = 0; |
| 1932 | u16 hwidx = sky2_read16(hw, STAT_PUT_IDX); | ||
| 1862 | 1933 | ||
| 1863 | rmb(); | 1934 | rmb(); |
| 1864 | 1935 | ||
| 1865 | for(;;) { | 1936 | while (hw->st_idx != hwidx) { |
| 1866 | struct sky2_status_le *le = hw->st_le + hw->st_idx; | 1937 | struct sky2_status_le *le = hw->st_le + hw->st_idx; |
| 1867 | struct net_device *dev; | 1938 | struct net_device *dev; |
| 1868 | struct sky2_port *sky2; | 1939 | struct sky2_port *sky2; |
| 1869 | struct sk_buff *skb; | 1940 | struct sk_buff *skb; |
| 1870 | u32 status; | 1941 | u32 status; |
| 1871 | u16 length; | 1942 | u16 length; |
| 1872 | u8 link, opcode; | ||
| 1873 | 1943 | ||
| 1874 | opcode = le->opcode; | 1944 | hw->st_idx = RING_NEXT(hw->st_idx, STATUS_RING_SIZE); |
| 1875 | if (!opcode) | ||
| 1876 | break; | ||
| 1877 | opcode &= ~HW_OWNER; | ||
| 1878 | 1945 | ||
| 1879 | hw->st_idx = (hw->st_idx + 1) % STATUS_RING_SIZE; | 1946 | BUG_ON(le->link >= 2); |
| 1880 | le->opcode = 0; | 1947 | dev = hw->dev[le->link]; |
| 1881 | |||
| 1882 | link = le->link; | ||
| 1883 | BUG_ON(link >= 2); | ||
| 1884 | dev = hw->dev[link]; | ||
| 1885 | 1948 | ||
| 1886 | sky2 = netdev_priv(dev); | 1949 | sky2 = netdev_priv(dev); |
| 1887 | length = le->length; | 1950 | length = le->length; |
| 1888 | status = le->status; | 1951 | status = le->status; |
| 1889 | 1952 | ||
| 1890 | switch (opcode) { | 1953 | switch (le->opcode & ~HW_OWNER) { |
| 1891 | case OP_RXSTAT: | 1954 | case OP_RXSTAT: |
| 1892 | skb = sky2_receive(sky2, length, status); | 1955 | skb = sky2_receive(sky2, length, status); |
| 1893 | if (!skb) | 1956 | if (!skb) |
| @@ -1927,7 +1990,8 @@ static int sky2_status_intr(struct sky2_hw *hw, int to_do) | |||
| 1927 | 1990 | ||
| 1928 | case OP_TXINDEXLE: | 1991 | case OP_TXINDEXLE: |
| 1929 | /* TX index reports status for both ports */ | 1992 | /* TX index reports status for both ports */ |
| 1930 | sky2_tx_done(hw->dev[0], status & 0xffff); | 1993 | BUILD_BUG_ON(TX_RING_SIZE > 0x1000); |
| 1994 | sky2_tx_done(hw->dev[0], status & 0xfff); | ||
| 1931 | if (hw->dev[1]) | 1995 | if (hw->dev[1]) |
| 1932 | sky2_tx_done(hw->dev[1], | 1996 | sky2_tx_done(hw->dev[1], |
| 1933 | ((status >> 24) & 0xff) | 1997 | ((status >> 24) & 0xff) |
| @@ -1937,8 +2001,8 @@ static int sky2_status_intr(struct sky2_hw *hw, int to_do) | |||
| 1937 | default: | 2001 | default: |
| 1938 | if (net_ratelimit()) | 2002 | if (net_ratelimit()) |
| 1939 | printk(KERN_WARNING PFX | 2003 | printk(KERN_WARNING PFX |
| 1940 | "unknown status opcode 0x%x\n", opcode); | 2004 | "unknown status opcode 0x%x\n", le->opcode); |
| 1941 | break; | 2005 | goto exit_loop; |
| 1942 | } | 2006 | } |
| 1943 | } | 2007 | } |
| 1944 | 2008 | ||
| @@ -2089,12 +2153,13 @@ static void sky2_descriptor_error(struct sky2_hw *hw, unsigned port, | |||
| 2089 | */ | 2153 | */ |
| 2090 | static void sky2_idle(unsigned long arg) | 2154 | static void sky2_idle(unsigned long arg) |
| 2091 | { | 2155 | { |
| 2092 | struct net_device *dev = (struct net_device *) arg; | 2156 | struct sky2_hw *hw = (struct sky2_hw *) arg; |
| 2157 | struct net_device *dev = hw->dev[0]; | ||
| 2093 | 2158 | ||
| 2094 | local_irq_disable(); | ||
| 2095 | if (__netif_rx_schedule_prep(dev)) | 2159 | if (__netif_rx_schedule_prep(dev)) |
| 2096 | __netif_rx_schedule(dev); | 2160 | __netif_rx_schedule(dev); |
| 2097 | local_irq_enable(); | 2161 | |
| 2162 | mod_timer(&hw->idle_timer, jiffies + msecs_to_jiffies(idle_timeout)); | ||
| 2098 | } | 2163 | } |
| 2099 | 2164 | ||
| 2100 | 2165 | ||
| @@ -2105,65 +2170,46 @@ static int sky2_poll(struct net_device *dev0, int *budget) | |||
| 2105 | int work_done = 0; | 2170 | int work_done = 0; |
| 2106 | u32 status = sky2_read32(hw, B0_Y2_SP_EISR); | 2171 | u32 status = sky2_read32(hw, B0_Y2_SP_EISR); |
| 2107 | 2172 | ||
| 2108 | restart_poll: | 2173 | if (status & Y2_IS_HW_ERR) |
| 2109 | if (unlikely(status & ~Y2_IS_STAT_BMU)) { | 2174 | sky2_hw_intr(hw); |
| 2110 | if (status & Y2_IS_HW_ERR) | ||
| 2111 | sky2_hw_intr(hw); | ||
| 2112 | 2175 | ||
| 2113 | if (status & Y2_IS_IRQ_PHY1) | 2176 | if (status & Y2_IS_IRQ_PHY1) |
| 2114 | sky2_phy_intr(hw, 0); | 2177 | sky2_phy_intr(hw, 0); |
| 2115 | 2178 | ||
| 2116 | if (status & Y2_IS_IRQ_PHY2) | 2179 | if (status & Y2_IS_IRQ_PHY2) |
| 2117 | sky2_phy_intr(hw, 1); | 2180 | sky2_phy_intr(hw, 1); |
| 2118 | 2181 | ||
| 2119 | if (status & Y2_IS_IRQ_MAC1) | 2182 | if (status & Y2_IS_IRQ_MAC1) |
| 2120 | sky2_mac_intr(hw, 0); | 2183 | sky2_mac_intr(hw, 0); |
| 2121 | 2184 | ||
| 2122 | if (status & Y2_IS_IRQ_MAC2) | 2185 | if (status & Y2_IS_IRQ_MAC2) |
| 2123 | sky2_mac_intr(hw, 1); | 2186 | sky2_mac_intr(hw, 1); |
| 2124 | 2187 | ||
| 2125 | if (status & Y2_IS_CHK_RX1) | 2188 | if (status & Y2_IS_CHK_RX1) |
| 2126 | sky2_descriptor_error(hw, 0, "receive", Y2_IS_CHK_RX1); | 2189 | sky2_descriptor_error(hw, 0, "receive", Y2_IS_CHK_RX1); |
| 2127 | 2190 | ||
| 2128 | if (status & Y2_IS_CHK_RX2) | 2191 | if (status & Y2_IS_CHK_RX2) |
| 2129 | sky2_descriptor_error(hw, 1, "receive", Y2_IS_CHK_RX2); | 2192 | sky2_descriptor_error(hw, 1, "receive", Y2_IS_CHK_RX2); |
| 2130 | 2193 | ||
| 2131 | if (status & Y2_IS_CHK_TXA1) | 2194 | if (status & Y2_IS_CHK_TXA1) |
| 2132 | sky2_descriptor_error(hw, 0, "transmit", Y2_IS_CHK_TXA1); | 2195 | sky2_descriptor_error(hw, 0, "transmit", Y2_IS_CHK_TXA1); |
| 2133 | 2196 | ||
| 2134 | if (status & Y2_IS_CHK_TXA2) | 2197 | if (status & Y2_IS_CHK_TXA2) |
| 2135 | sky2_descriptor_error(hw, 1, "transmit", Y2_IS_CHK_TXA2); | 2198 | sky2_descriptor_error(hw, 1, "transmit", Y2_IS_CHK_TXA2); |
| 2136 | } | ||
| 2137 | |||
| 2138 | if (status & Y2_IS_STAT_BMU) { | ||
| 2139 | work_done += sky2_status_intr(hw, work_limit - work_done); | ||
| 2140 | *budget -= work_done; | ||
| 2141 | dev0->quota -= work_done; | ||
| 2142 | 2199 | ||
| 2143 | if (work_done >= work_limit) | 2200 | work_done = sky2_status_intr(hw, work_limit); |
| 2144 | return 1; | 2201 | *budget -= work_done; |
| 2202 | dev0->quota -= work_done; | ||
| 2145 | 2203 | ||
| 2204 | if (status & Y2_IS_STAT_BMU) | ||
| 2146 | sky2_write32(hw, STAT_CTRL, SC_STAT_CLR_IRQ); | 2205 | sky2_write32(hw, STAT_CTRL, SC_STAT_CLR_IRQ); |
| 2147 | } | ||
| 2148 | |||
| 2149 | mod_timer(&hw->idle_timer, jiffies + HZ); | ||
| 2150 | 2206 | ||
| 2151 | local_irq_disable(); | 2207 | if (sky2_more_work(hw)) |
| 2152 | __netif_rx_complete(dev0); | 2208 | return 1; |
| 2153 | 2209 | ||
| 2154 | status = sky2_read32(hw, B0_Y2_SP_LISR); | 2210 | netif_rx_complete(dev0); |
| 2155 | |||
| 2156 | if (unlikely(status)) { | ||
| 2157 | /* More work pending, try and keep going */ | ||
| 2158 | if (__netif_rx_schedule_prep(dev0)) { | ||
| 2159 | __netif_rx_reschedule(dev0, work_done); | ||
| 2160 | status = sky2_read32(hw, B0_Y2_SP_EISR); | ||
| 2161 | local_irq_enable(); | ||
| 2162 | goto restart_poll; | ||
| 2163 | } | ||
| 2164 | } | ||
| 2165 | 2211 | ||
| 2166 | local_irq_enable(); | 2212 | sky2_read32(hw, B0_Y2_SP_LISR); |
| 2167 | return 0; | 2213 | return 0; |
| 2168 | } | 2214 | } |
| 2169 | 2215 | ||
| @@ -2244,13 +2290,6 @@ static int __devinit sky2_reset(struct sky2_hw *hw) | |||
| 2244 | return -EOPNOTSUPP; | 2290 | return -EOPNOTSUPP; |
| 2245 | } | 2291 | } |
| 2246 | 2292 | ||
| 2247 | /* This chip is new and not tested yet */ | ||
| 2248 | if (hw->chip_id == CHIP_ID_YUKON_EC_U) { | ||
| 2249 | pr_info(PFX "%s: is a version of Yukon 2 chipset that has not been tested yet.\n", | ||
| 2250 | pci_name(hw->pdev)); | ||
| 2251 | pr_info("Please report success/failure to maintainer <shemminger@osdl.org>\n"); | ||
| 2252 | } | ||
| 2253 | |||
| 2254 | /* disable ASF */ | 2293 | /* disable ASF */ |
| 2255 | if (hw->chip_id <= CHIP_ID_YUKON_EC) { | 2294 | if (hw->chip_id <= CHIP_ID_YUKON_EC) { |
| 2256 | sky2_write8(hw, B28_Y2_ASF_STAT_CMD, Y2_ASF_RESET); | 2295 | sky2_write8(hw, B28_Y2_ASF_STAT_CMD, Y2_ASF_RESET); |
| @@ -3054,12 +3093,7 @@ static __devinit struct net_device *sky2_init_netdev(struct sky2_hw *hw, | |||
| 3054 | sky2->duplex = -1; | 3093 | sky2->duplex = -1; |
| 3055 | sky2->speed = -1; | 3094 | sky2->speed = -1; |
| 3056 | sky2->advertising = sky2_supported_modes(hw); | 3095 | sky2->advertising = sky2_supported_modes(hw); |
| 3057 | 3096 | sky2->rx_csum = 1; | |
| 3058 | /* Receive checksum disabled for Yukon XL | ||
| 3059 | * because of observed problems with incorrect | ||
| 3060 | * values when multiple packets are received in one interrupt | ||
| 3061 | */ | ||
| 3062 | sky2->rx_csum = (hw->chip_id != CHIP_ID_YUKON_XL); | ||
| 3063 | 3097 | ||
| 3064 | spin_lock_init(&sky2->phy_lock); | 3098 | spin_lock_init(&sky2->phy_lock); |
| 3065 | sky2->tx_pending = TX_DEF_PENDING; | 3099 | sky2->tx_pending = TX_DEF_PENDING; |
| @@ -3302,7 +3336,10 @@ static int __devinit sky2_probe(struct pci_dev *pdev, | |||
| 3302 | 3336 | ||
| 3303 | sky2_write32(hw, B0_IMSK, Y2_IS_BASE); | 3337 | sky2_write32(hw, B0_IMSK, Y2_IS_BASE); |
| 3304 | 3338 | ||
| 3305 | setup_timer(&hw->idle_timer, sky2_idle, (unsigned long) dev); | 3339 | setup_timer(&hw->idle_timer, sky2_idle, (unsigned long) hw); |
| 3340 | if (idle_timeout > 0) | ||
| 3341 | mod_timer(&hw->idle_timer, | ||
| 3342 | jiffies + msecs_to_jiffies(idle_timeout)); | ||
| 3306 | 3343 | ||
| 3307 | pci_set_drvdata(pdev, hw); | 3344 | pci_set_drvdata(pdev, hw); |
| 3308 | 3345 | ||
| @@ -3342,6 +3379,8 @@ static void __devexit sky2_remove(struct pci_dev *pdev) | |||
| 3342 | del_timer_sync(&hw->idle_timer); | 3379 | del_timer_sync(&hw->idle_timer); |
| 3343 | 3380 | ||
| 3344 | sky2_write32(hw, B0_IMSK, 0); | 3381 | sky2_write32(hw, B0_IMSK, 0); |
| 3382 | synchronize_irq(hw->pdev->irq); | ||
| 3383 | |||
| 3345 | dev0 = hw->dev[0]; | 3384 | dev0 = hw->dev[0]; |
| 3346 | dev1 = hw->dev[1]; | 3385 | dev1 = hw->dev[1]; |
| 3347 | if (dev1) | 3386 | if (dev1) |
diff --git a/drivers/net/sky2.h b/drivers/net/sky2.h index b026f5653f04..8a0bc5525f0a 100644 --- a/drivers/net/sky2.h +++ b/drivers/net/sky2.h | |||
| @@ -214,6 +214,8 @@ enum csr_regs { | |||
| 214 | enum { | 214 | enum { |
| 215 | Y2_VMAIN_AVAIL = 1<<17,/* VMAIN available (YUKON-2 only) */ | 215 | Y2_VMAIN_AVAIL = 1<<17,/* VMAIN available (YUKON-2 only) */ |
| 216 | Y2_VAUX_AVAIL = 1<<16,/* VAUX available (YUKON-2 only) */ | 216 | Y2_VAUX_AVAIL = 1<<16,/* VAUX available (YUKON-2 only) */ |
| 217 | Y2_HW_WOL_ON = 1<<15,/* HW WOL On (Yukon-EC Ultra A1 only) */ | ||
| 218 | Y2_HW_WOL_OFF = 1<<14,/* HW WOL On (Yukon-EC Ultra A1 only) */ | ||
| 217 | Y2_ASF_ENABLE = 1<<13,/* ASF Unit Enable (YUKON-2 only) */ | 219 | Y2_ASF_ENABLE = 1<<13,/* ASF Unit Enable (YUKON-2 only) */ |
| 218 | Y2_ASF_DISABLE = 1<<12,/* ASF Unit Disable (YUKON-2 only) */ | 220 | Y2_ASF_DISABLE = 1<<12,/* ASF Unit Disable (YUKON-2 only) */ |
| 219 | Y2_CLK_RUN_ENA = 1<<11,/* CLK_RUN Enable (YUKON-2 only) */ | 221 | Y2_CLK_RUN_ENA = 1<<11,/* CLK_RUN Enable (YUKON-2 only) */ |
| @@ -378,6 +380,9 @@ enum { | |||
| 378 | CHIP_REV_YU_EC_A1 = 0, /* Chip Rev. for Yukon-EC A1/A0 */ | 380 | CHIP_REV_YU_EC_A1 = 0, /* Chip Rev. for Yukon-EC A1/A0 */ |
| 379 | CHIP_REV_YU_EC_A2 = 1, /* Chip Rev. for Yukon-EC A2 */ | 381 | CHIP_REV_YU_EC_A2 = 1, /* Chip Rev. for Yukon-EC A2 */ |
| 380 | CHIP_REV_YU_EC_A3 = 2, /* Chip Rev. for Yukon-EC A3 */ | 382 | CHIP_REV_YU_EC_A3 = 2, /* Chip Rev. for Yukon-EC A3 */ |
| 383 | |||
| 384 | CHIP_REV_YU_EC_U_A0 = 0, | ||
| 385 | CHIP_REV_YU_EC_U_A1 = 1, | ||
| 381 | }; | 386 | }; |
| 382 | 387 | ||
| 383 | /* B2_Y2_CLK_GATE 8 bit Clock Gating (Yukon-2 only) */ | 388 | /* B2_Y2_CLK_GATE 8 bit Clock Gating (Yukon-2 only) */ |
diff --git a/drivers/net/spider_net.c b/drivers/net/spider_net.c index 43f5e86fc559..394339d5e87c 100644 --- a/drivers/net/spider_net.c +++ b/drivers/net/spider_net.c | |||
| @@ -1652,6 +1652,8 @@ spider_net_enable_card(struct spider_net_card *card) | |||
| 1652 | { SPIDER_NET_GFTRESTRT, SPIDER_NET_RESTART_VALUE }, | 1652 | { SPIDER_NET_GFTRESTRT, SPIDER_NET_RESTART_VALUE }, |
| 1653 | 1653 | ||
| 1654 | { SPIDER_NET_GMRWOLCTRL, 0 }, | 1654 | { SPIDER_NET_GMRWOLCTRL, 0 }, |
| 1655 | { SPIDER_NET_GTESTMD, 0x10000000 }, | ||
| 1656 | { SPIDER_NET_GTTQMSK, 0x00400040 }, | ||
| 1655 | { SPIDER_NET_GTESTMD, 0 }, | 1657 | { SPIDER_NET_GTESTMD, 0 }, |
| 1656 | 1658 | ||
| 1657 | { SPIDER_NET_GMACINTEN, 0 }, | 1659 | { SPIDER_NET_GMACINTEN, 0 }, |
| @@ -1792,15 +1794,7 @@ spider_net_setup_phy(struct spider_net_card *card) | |||
| 1792 | if (phy->def->ops->setup_forced) | 1794 | if (phy->def->ops->setup_forced) |
| 1793 | phy->def->ops->setup_forced(phy, SPEED_1000, DUPLEX_FULL); | 1795 | phy->def->ops->setup_forced(phy, SPEED_1000, DUPLEX_FULL); |
| 1794 | 1796 | ||
| 1795 | /* the following two writes could be moved to sungem_phy.c */ | 1797 | phy->def->ops->enable_fiber(phy); |
| 1796 | /* enable fiber mode */ | ||
| 1797 | spider_net_write_phy(card->netdev, 1, MII_NCONFIG, 0x9020); | ||
| 1798 | /* LEDs active in both modes, autosense prio = fiber */ | ||
| 1799 | spider_net_write_phy(card->netdev, 1, MII_NCONFIG, 0x945f); | ||
| 1800 | |||
| 1801 | /* switch off fibre autoneg */ | ||
| 1802 | spider_net_write_phy(card->netdev, 1, MII_NCONFIG, 0xfc01); | ||
| 1803 | spider_net_write_phy(card->netdev, 1, 0x0b, 0x0004); | ||
| 1804 | 1798 | ||
| 1805 | phy->def->ops->read_link(phy); | 1799 | phy->def->ops->read_link(phy); |
| 1806 | pr_info("Found %s with %i Mbps, %s-duplex.\n", phy->def->name, | 1800 | pr_info("Found %s with %i Mbps, %s-duplex.\n", phy->def->name, |
diff --git a/drivers/net/spider_net.h b/drivers/net/spider_net.h index 5922b529a048..3b8d951cf73c 100644 --- a/drivers/net/spider_net.h +++ b/drivers/net/spider_net.h | |||
| @@ -120,6 +120,8 @@ extern char spider_net_driver_name[]; | |||
| 120 | #define SPIDER_NET_GMRUAFILnR 0x00000500 | 120 | #define SPIDER_NET_GMRUAFILnR 0x00000500 |
| 121 | #define SPIDER_NET_GMRUA0FIL15R 0x00000578 | 121 | #define SPIDER_NET_GMRUA0FIL15R 0x00000578 |
| 122 | 122 | ||
| 123 | #define SPIDER_NET_GTTQMSK 0x00000934 | ||
| 124 | |||
| 123 | /* RX DMA controller registers, all 0x00000a.. are for DMA controller A, | 125 | /* RX DMA controller registers, all 0x00000a.. are for DMA controller A, |
| 124 | * 0x00000b.. for DMA controller B, etc. */ | 126 | * 0x00000b.. for DMA controller B, etc. */ |
| 125 | #define SPIDER_NET_GDADCHA 0x00000a00 | 127 | #define SPIDER_NET_GDADCHA 0x00000a00 |
diff --git a/drivers/net/sungem_phy.c b/drivers/net/sungem_phy.c index 046371ee5bbe..b2ddd5e79303 100644 --- a/drivers/net/sungem_phy.c +++ b/drivers/net/sungem_phy.c | |||
| @@ -329,6 +329,30 @@ static int bcm5421_init(struct mii_phy* phy) | |||
| 329 | return 0; | 329 | return 0; |
| 330 | } | 330 | } |
| 331 | 331 | ||
| 332 | static int bcm5421_enable_fiber(struct mii_phy* phy) | ||
| 333 | { | ||
| 334 | /* enable fiber mode */ | ||
| 335 | phy_write(phy, MII_NCONFIG, 0x9020); | ||
| 336 | /* LEDs active in both modes, autosense prio = fiber */ | ||
| 337 | phy_write(phy, MII_NCONFIG, 0x945f); | ||
| 338 | |||
| 339 | /* switch off fibre autoneg */ | ||
| 340 | phy_write(phy, MII_NCONFIG, 0xfc01); | ||
| 341 | phy_write(phy, 0x0b, 0x0004); | ||
| 342 | |||
| 343 | return 0; | ||
| 344 | } | ||
| 345 | |||
| 346 | static int bcm5461_enable_fiber(struct mii_phy* phy) | ||
| 347 | { | ||
| 348 | phy_write(phy, MII_NCONFIG, 0xfc0c); | ||
| 349 | phy_write(phy, MII_BMCR, 0x4140); | ||
| 350 | phy_write(phy, MII_NCONFIG, 0xfc0b); | ||
| 351 | phy_write(phy, MII_BMCR, 0x0140); | ||
| 352 | |||
| 353 | return 0; | ||
| 354 | } | ||
| 355 | |||
| 332 | static int bcm54xx_setup_aneg(struct mii_phy *phy, u32 advertise) | 356 | static int bcm54xx_setup_aneg(struct mii_phy *phy, u32 advertise) |
| 333 | { | 357 | { |
| 334 | u16 ctl, adv; | 358 | u16 ctl, adv; |
| @@ -762,6 +786,7 @@ static struct mii_phy_ops bcm5421_phy_ops = { | |||
| 762 | .setup_forced = bcm54xx_setup_forced, | 786 | .setup_forced = bcm54xx_setup_forced, |
| 763 | .poll_link = genmii_poll_link, | 787 | .poll_link = genmii_poll_link, |
| 764 | .read_link = bcm54xx_read_link, | 788 | .read_link = bcm54xx_read_link, |
| 789 | .enable_fiber = bcm5421_enable_fiber, | ||
| 765 | }; | 790 | }; |
| 766 | 791 | ||
| 767 | static struct mii_phy_def bcm5421_phy_def = { | 792 | static struct mii_phy_def bcm5421_phy_def = { |
| @@ -792,6 +817,25 @@ static struct mii_phy_def bcm5421k2_phy_def = { | |||
| 792 | .ops = &bcm5421k2_phy_ops | 817 | .ops = &bcm5421k2_phy_ops |
| 793 | }; | 818 | }; |
| 794 | 819 | ||
| 820 | static struct mii_phy_ops bcm5461_phy_ops = { | ||
| 821 | .init = bcm5421_init, | ||
| 822 | .suspend = generic_suspend, | ||
| 823 | .setup_aneg = bcm54xx_setup_aneg, | ||
| 824 | .setup_forced = bcm54xx_setup_forced, | ||
| 825 | .poll_link = genmii_poll_link, | ||
| 826 | .read_link = bcm54xx_read_link, | ||
| 827 | .enable_fiber = bcm5461_enable_fiber, | ||
| 828 | }; | ||
| 829 | |||
| 830 | static struct mii_phy_def bcm5461_phy_def = { | ||
| 831 | .phy_id = 0x002060c0, | ||
| 832 | .phy_id_mask = 0xfffffff0, | ||
| 833 | .name = "BCM5461", | ||
| 834 | .features = MII_GBIT_FEATURES, | ||
| 835 | .magic_aneg = 1, | ||
| 836 | .ops = &bcm5461_phy_ops | ||
| 837 | }; | ||
| 838 | |||
| 795 | /* Broadcom BCM 5462 built-in Vesta */ | 839 | /* Broadcom BCM 5462 built-in Vesta */ |
| 796 | static struct mii_phy_ops bcm5462V_phy_ops = { | 840 | static struct mii_phy_ops bcm5462V_phy_ops = { |
| 797 | .init = bcm5421_init, | 841 | .init = bcm5421_init, |
| @@ -857,6 +901,7 @@ static struct mii_phy_def* mii_phy_table[] = { | |||
| 857 | &bcm5411_phy_def, | 901 | &bcm5411_phy_def, |
| 858 | &bcm5421_phy_def, | 902 | &bcm5421_phy_def, |
| 859 | &bcm5421k2_phy_def, | 903 | &bcm5421k2_phy_def, |
| 904 | &bcm5461_phy_def, | ||
| 860 | &bcm5462V_phy_def, | 905 | &bcm5462V_phy_def, |
| 861 | &marvell_phy_def, | 906 | &marvell_phy_def, |
| 862 | &genmii_phy_def, | 907 | &genmii_phy_def, |
diff --git a/drivers/net/sungem_phy.h b/drivers/net/sungem_phy.h index 430544496c52..69e125197fcf 100644 --- a/drivers/net/sungem_phy.h +++ b/drivers/net/sungem_phy.h | |||
| @@ -12,6 +12,7 @@ struct mii_phy_ops | |||
| 12 | int (*setup_forced)(struct mii_phy *phy, int speed, int fd); | 12 | int (*setup_forced)(struct mii_phy *phy, int speed, int fd); |
| 13 | int (*poll_link)(struct mii_phy *phy); | 13 | int (*poll_link)(struct mii_phy *phy); |
| 14 | int (*read_link)(struct mii_phy *phy); | 14 | int (*read_link)(struct mii_phy *phy); |
| 15 | int (*enable_fiber)(struct mii_phy *phy); | ||
| 15 | }; | 16 | }; |
| 16 | 17 | ||
| 17 | /* Structure used to statically define an mii/gii based PHY */ | 18 | /* Structure used to statically define an mii/gii based PHY */ |
diff --git a/drivers/net/tg3.c b/drivers/net/tg3.c index beeb612be98f..49ad60b72657 100644 --- a/drivers/net/tg3.c +++ b/drivers/net/tg3.c | |||
| @@ -69,8 +69,8 @@ | |||
| 69 | 69 | ||
| 70 | #define DRV_MODULE_NAME "tg3" | 70 | #define DRV_MODULE_NAME "tg3" |
| 71 | #define PFX DRV_MODULE_NAME ": " | 71 | #define PFX DRV_MODULE_NAME ": " |
| 72 | #define DRV_MODULE_VERSION "3.57" | 72 | #define DRV_MODULE_VERSION "3.58" |
| 73 | #define DRV_MODULE_RELDATE "Apr 28, 2006" | 73 | #define DRV_MODULE_RELDATE "May 22, 2006" |
| 74 | 74 | ||
| 75 | #define TG3_DEF_MAC_MODE 0 | 75 | #define TG3_DEF_MAC_MODE 0 |
| 76 | #define TG3_DEF_RX_MODE 0 | 76 | #define TG3_DEF_RX_MODE 0 |
| @@ -6488,6 +6488,10 @@ static void tg3_periodic_fetch_stats(struct tg3 *tp) | |||
| 6488 | TG3_STAT_ADD32(&sp->rx_frame_too_long_errors, MAC_RX_STATS_FRAME_TOO_LONG); | 6488 | TG3_STAT_ADD32(&sp->rx_frame_too_long_errors, MAC_RX_STATS_FRAME_TOO_LONG); |
| 6489 | TG3_STAT_ADD32(&sp->rx_jabbers, MAC_RX_STATS_JABBERS); | 6489 | TG3_STAT_ADD32(&sp->rx_jabbers, MAC_RX_STATS_JABBERS); |
| 6490 | TG3_STAT_ADD32(&sp->rx_undersize_packets, MAC_RX_STATS_UNDERSIZE); | 6490 | TG3_STAT_ADD32(&sp->rx_undersize_packets, MAC_RX_STATS_UNDERSIZE); |
| 6491 | |||
| 6492 | TG3_STAT_ADD32(&sp->rxbds_empty, RCVLPC_NO_RCV_BD_CNT); | ||
| 6493 | TG3_STAT_ADD32(&sp->rx_discards, RCVLPC_IN_DISCARDS_CNT); | ||
| 6494 | TG3_STAT_ADD32(&sp->rx_errors, RCVLPC_IN_ERRORS_CNT); | ||
| 6491 | } | 6495 | } |
| 6492 | 6496 | ||
| 6493 | static void tg3_timer(unsigned long __opaque) | 6497 | static void tg3_timer(unsigned long __opaque) |
| @@ -7653,21 +7657,23 @@ static int tg3_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) | |||
| 7653 | cmd->supported |= (SUPPORTED_1000baseT_Half | | 7657 | cmd->supported |= (SUPPORTED_1000baseT_Half | |
| 7654 | SUPPORTED_1000baseT_Full); | 7658 | SUPPORTED_1000baseT_Full); |
| 7655 | 7659 | ||
| 7656 | if (!(tp->tg3_flags2 & TG3_FLG2_ANY_SERDES)) | 7660 | if (!(tp->tg3_flags2 & TG3_FLG2_ANY_SERDES)) { |
| 7657 | cmd->supported |= (SUPPORTED_100baseT_Half | | 7661 | cmd->supported |= (SUPPORTED_100baseT_Half | |
| 7658 | SUPPORTED_100baseT_Full | | 7662 | SUPPORTED_100baseT_Full | |
| 7659 | SUPPORTED_10baseT_Half | | 7663 | SUPPORTED_10baseT_Half | |
| 7660 | SUPPORTED_10baseT_Full | | 7664 | SUPPORTED_10baseT_Full | |
| 7661 | SUPPORTED_MII); | 7665 | SUPPORTED_MII); |
| 7662 | else | 7666 | cmd->port = PORT_TP; |
| 7667 | } else { | ||
| 7663 | cmd->supported |= SUPPORTED_FIBRE; | 7668 | cmd->supported |= SUPPORTED_FIBRE; |
| 7669 | cmd->port = PORT_FIBRE; | ||
| 7670 | } | ||
| 7664 | 7671 | ||
| 7665 | cmd->advertising = tp->link_config.advertising; | 7672 | cmd->advertising = tp->link_config.advertising; |
| 7666 | if (netif_running(dev)) { | 7673 | if (netif_running(dev)) { |
| 7667 | cmd->speed = tp->link_config.active_speed; | 7674 | cmd->speed = tp->link_config.active_speed; |
| 7668 | cmd->duplex = tp->link_config.active_duplex; | 7675 | cmd->duplex = tp->link_config.active_duplex; |
| 7669 | } | 7676 | } |
| 7670 | cmd->port = 0; | ||
| 7671 | cmd->phy_address = PHY_ADDR; | 7677 | cmd->phy_address = PHY_ADDR; |
| 7672 | cmd->transceiver = 0; | 7678 | cmd->transceiver = 0; |
| 7673 | cmd->autoneg = tp->link_config.autoneg; | 7679 | cmd->autoneg = tp->link_config.autoneg; |
| @@ -8454,6 +8460,9 @@ static int tg3_run_loopback(struct tg3 *tp, int loopback_mode) | |||
| 8454 | 8460 | ||
| 8455 | tx_len = 1514; | 8461 | tx_len = 1514; |
| 8456 | skb = dev_alloc_skb(tx_len); | 8462 | skb = dev_alloc_skb(tx_len); |
| 8463 | if (!skb) | ||
| 8464 | return -ENOMEM; | ||
| 8465 | |||
| 8457 | tx_data = skb_put(skb, tx_len); | 8466 | tx_data = skb_put(skb, tx_len); |
| 8458 | memcpy(tx_data, tp->dev->dev_addr, 6); | 8467 | memcpy(tx_data, tp->dev->dev_addr, 6); |
| 8459 | memset(tx_data + 6, 0x0, 8); | 8468 | memset(tx_data + 6, 0x0, 8); |
diff --git a/drivers/net/tulip/winbond-840.c b/drivers/net/tulip/winbond-840.c index ba05dedf29d3..136a70c4d5e4 100644 --- a/drivers/net/tulip/winbond-840.c +++ b/drivers/net/tulip/winbond-840.c | |||
| @@ -850,7 +850,7 @@ static void init_rxtx_rings(struct net_device *dev) | |||
| 850 | break; | 850 | break; |
| 851 | skb->dev = dev; /* Mark as being used by this device. */ | 851 | skb->dev = dev; /* Mark as being used by this device. */ |
| 852 | np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data, | 852 | np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data, |
| 853 | skb->len,PCI_DMA_FROMDEVICE); | 853 | np->rx_buf_sz,PCI_DMA_FROMDEVICE); |
| 854 | 854 | ||
| 855 | np->rx_ring[i].buffer1 = np->rx_addr[i]; | 855 | np->rx_ring[i].buffer1 = np->rx_addr[i]; |
| 856 | np->rx_ring[i].status = DescOwn; | 856 | np->rx_ring[i].status = DescOwn; |
| @@ -1316,7 +1316,7 @@ static int netdev_rx(struct net_device *dev) | |||
| 1316 | skb->dev = dev; /* Mark as being used by this device. */ | 1316 | skb->dev = dev; /* Mark as being used by this device. */ |
| 1317 | np->rx_addr[entry] = pci_map_single(np->pci_dev, | 1317 | np->rx_addr[entry] = pci_map_single(np->pci_dev, |
| 1318 | skb->data, | 1318 | skb->data, |
| 1319 | skb->len, PCI_DMA_FROMDEVICE); | 1319 | np->rx_buf_sz, PCI_DMA_FROMDEVICE); |
| 1320 | np->rx_ring[entry].buffer1 = np->rx_addr[entry]; | 1320 | np->rx_ring[entry].buffer1 = np->rx_addr[entry]; |
| 1321 | } | 1321 | } |
| 1322 | wmb(); | 1322 | wmb(); |
diff --git a/drivers/net/via-rhine.c b/drivers/net/via-rhine.c index a6dc53b4250d..fdc21037f6dc 100644 --- a/drivers/net/via-rhine.c +++ b/drivers/net/via-rhine.c | |||
| @@ -491,8 +491,6 @@ struct rhine_private { | |||
| 491 | u8 tx_thresh, rx_thresh; | 491 | u8 tx_thresh, rx_thresh; |
| 492 | 492 | ||
| 493 | struct mii_if_info mii_if; | 493 | struct mii_if_info mii_if; |
| 494 | struct work_struct tx_timeout_task; | ||
| 495 | struct work_struct check_media_task; | ||
| 496 | void __iomem *base; | 494 | void __iomem *base; |
| 497 | }; | 495 | }; |
| 498 | 496 | ||
| @@ -500,8 +498,6 @@ static int mdio_read(struct net_device *dev, int phy_id, int location); | |||
| 500 | static void mdio_write(struct net_device *dev, int phy_id, int location, int value); | 498 | static void mdio_write(struct net_device *dev, int phy_id, int location, int value); |
| 501 | static int rhine_open(struct net_device *dev); | 499 | static int rhine_open(struct net_device *dev); |
| 502 | static void rhine_tx_timeout(struct net_device *dev); | 500 | static void rhine_tx_timeout(struct net_device *dev); |
| 503 | static void rhine_tx_timeout_task(struct net_device *dev); | ||
| 504 | static void rhine_check_media_task(struct net_device *dev); | ||
| 505 | static int rhine_start_tx(struct sk_buff *skb, struct net_device *dev); | 501 | static int rhine_start_tx(struct sk_buff *skb, struct net_device *dev); |
| 506 | static irqreturn_t rhine_interrupt(int irq, void *dev_instance, struct pt_regs *regs); | 502 | static irqreturn_t rhine_interrupt(int irq, void *dev_instance, struct pt_regs *regs); |
| 507 | static void rhine_tx(struct net_device *dev); | 503 | static void rhine_tx(struct net_device *dev); |
| @@ -856,12 +852,6 @@ static int __devinit rhine_init_one(struct pci_dev *pdev, | |||
| 856 | if (rp->quirks & rqRhineI) | 852 | if (rp->quirks & rqRhineI) |
| 857 | dev->features |= NETIF_F_SG|NETIF_F_HW_CSUM; | 853 | dev->features |= NETIF_F_SG|NETIF_F_HW_CSUM; |
| 858 | 854 | ||
| 859 | INIT_WORK(&rp->tx_timeout_task, | ||
| 860 | (void (*)(void *))rhine_tx_timeout_task, dev); | ||
| 861 | |||
| 862 | INIT_WORK(&rp->check_media_task, | ||
| 863 | (void (*)(void *))rhine_check_media_task, dev); | ||
| 864 | |||
| 865 | /* dev->name not defined before register_netdev()! */ | 855 | /* dev->name not defined before register_netdev()! */ |
| 866 | rc = register_netdev(dev); | 856 | rc = register_netdev(dev); |
| 867 | if (rc) | 857 | if (rc) |
| @@ -1108,11 +1098,6 @@ static void rhine_set_carrier(struct mii_if_info *mii) | |||
| 1108 | netif_carrier_ok(mii->dev)); | 1098 | netif_carrier_ok(mii->dev)); |
| 1109 | } | 1099 | } |
| 1110 | 1100 | ||
| 1111 | static void rhine_check_media_task(struct net_device *dev) | ||
| 1112 | { | ||
| 1113 | rhine_check_media(dev, 0); | ||
| 1114 | } | ||
| 1115 | |||
| 1116 | static void init_registers(struct net_device *dev) | 1101 | static void init_registers(struct net_device *dev) |
| 1117 | { | 1102 | { |
| 1118 | struct rhine_private *rp = netdev_priv(dev); | 1103 | struct rhine_private *rp = netdev_priv(dev); |
| @@ -1166,8 +1151,8 @@ static void rhine_disable_linkmon(void __iomem *ioaddr, u32 quirks) | |||
| 1166 | if (quirks & rqRhineI) { | 1151 | if (quirks & rqRhineI) { |
| 1167 | iowrite8(0x01, ioaddr + MIIRegAddr); // MII_BMSR | 1152 | iowrite8(0x01, ioaddr + MIIRegAddr); // MII_BMSR |
| 1168 | 1153 | ||
| 1169 | /* Do not call from ISR! */ | 1154 | /* Can be called from ISR. Evil. */ |
| 1170 | msleep(1); | 1155 | mdelay(1); |
| 1171 | 1156 | ||
| 1172 | /* 0x80 must be set immediately before turning it off */ | 1157 | /* 0x80 must be set immediately before turning it off */ |
| 1173 | iowrite8(0x80, ioaddr + MIICmd); | 1158 | iowrite8(0x80, ioaddr + MIICmd); |
| @@ -1257,16 +1242,6 @@ static int rhine_open(struct net_device *dev) | |||
| 1257 | static void rhine_tx_timeout(struct net_device *dev) | 1242 | static void rhine_tx_timeout(struct net_device *dev) |
| 1258 | { | 1243 | { |
| 1259 | struct rhine_private *rp = netdev_priv(dev); | 1244 | struct rhine_private *rp = netdev_priv(dev); |
| 1260 | |||
| 1261 | /* | ||
| 1262 | * Move bulk of work outside of interrupt context | ||
| 1263 | */ | ||
| 1264 | schedule_work(&rp->tx_timeout_task); | ||
| 1265 | } | ||
| 1266 | |||
| 1267 | static void rhine_tx_timeout_task(struct net_device *dev) | ||
| 1268 | { | ||
| 1269 | struct rhine_private *rp = netdev_priv(dev); | ||
| 1270 | void __iomem *ioaddr = rp->base; | 1245 | void __iomem *ioaddr = rp->base; |
| 1271 | 1246 | ||
| 1272 | printk(KERN_WARNING "%s: Transmit timed out, status %4.4x, PHY status " | 1247 | printk(KERN_WARNING "%s: Transmit timed out, status %4.4x, PHY status " |
| @@ -1677,7 +1652,7 @@ static void rhine_error(struct net_device *dev, int intr_status) | |||
| 1677 | spin_lock(&rp->lock); | 1652 | spin_lock(&rp->lock); |
| 1678 | 1653 | ||
| 1679 | if (intr_status & IntrLinkChange) | 1654 | if (intr_status & IntrLinkChange) |
| 1680 | schedule_work(&rp->check_media_task); | 1655 | rhine_check_media(dev, 0); |
| 1681 | if (intr_status & IntrStatsMax) { | 1656 | if (intr_status & IntrStatsMax) { |
| 1682 | rp->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs); | 1657 | rp->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs); |
| 1683 | rp->stats.rx_missed_errors += ioread16(ioaddr + RxMissed); | 1658 | rp->stats.rx_missed_errors += ioread16(ioaddr + RxMissed); |
| @@ -1927,9 +1902,6 @@ static int rhine_close(struct net_device *dev) | |||
| 1927 | spin_unlock_irq(&rp->lock); | 1902 | spin_unlock_irq(&rp->lock); |
| 1928 | 1903 | ||
| 1929 | free_irq(rp->pdev->irq, dev); | 1904 | free_irq(rp->pdev->irq, dev); |
| 1930 | |||
| 1931 | flush_scheduled_work(); | ||
| 1932 | |||
| 1933 | free_rbufs(dev); | 1905 | free_rbufs(dev); |
| 1934 | free_tbufs(dev); | 1906 | free_tbufs(dev); |
| 1935 | free_ring(dev); | 1907 | free_ring(dev); |
diff --git a/drivers/net/wireless/bcm43xx/bcm43xx_main.c b/drivers/net/wireless/bcm43xx/bcm43xx_main.c index 9a06e61df0a2..7ed18cad29f7 100644 --- a/drivers/net/wireless/bcm43xx/bcm43xx_main.c +++ b/drivers/net/wireless/bcm43xx/bcm43xx_main.c | |||
| @@ -939,9 +939,9 @@ static int bcm43xx_sprom_extract(struct bcm43xx_private *bcm) | |||
| 939 | return 0; | 939 | return 0; |
| 940 | } | 940 | } |
| 941 | 941 | ||
| 942 | static void bcm43xx_geo_init(struct bcm43xx_private *bcm) | 942 | static int bcm43xx_geo_init(struct bcm43xx_private *bcm) |
| 943 | { | 943 | { |
| 944 | struct ieee80211_geo geo; | 944 | struct ieee80211_geo *geo; |
| 945 | struct ieee80211_channel *chan; | 945 | struct ieee80211_channel *chan; |
| 946 | int have_a = 0, have_bg = 0; | 946 | int have_a = 0, have_bg = 0; |
| 947 | int i; | 947 | int i; |
| @@ -949,7 +949,10 @@ static void bcm43xx_geo_init(struct bcm43xx_private *bcm) | |||
| 949 | struct bcm43xx_phyinfo *phy; | 949 | struct bcm43xx_phyinfo *phy; |
| 950 | const char *iso_country; | 950 | const char *iso_country; |
| 951 | 951 | ||
| 952 | memset(&geo, 0, sizeof(geo)); | 952 | geo = kzalloc(sizeof(*geo), GFP_KERNEL); |
| 953 | if (!geo) | ||
| 954 | return -ENOMEM; | ||
| 955 | |||
| 953 | for (i = 0; i < bcm->nr_80211_available; i++) { | 956 | for (i = 0; i < bcm->nr_80211_available; i++) { |
| 954 | phy = &(bcm->core_80211_ext[i].phy); | 957 | phy = &(bcm->core_80211_ext[i].phy); |
| 955 | switch (phy->type) { | 958 | switch (phy->type) { |
| @@ -967,31 +970,36 @@ static void bcm43xx_geo_init(struct bcm43xx_private *bcm) | |||
| 967 | iso_country = bcm43xx_locale_iso(bcm->sprom.locale); | 970 | iso_country = bcm43xx_locale_iso(bcm->sprom.locale); |
| 968 | 971 | ||
| 969 | if (have_a) { | 972 | if (have_a) { |
| 970 | for (i = 0, channel = 0; channel < 201; channel++) { | 973 | for (i = 0, channel = IEEE80211_52GHZ_MIN_CHANNEL; |
| 971 | chan = &geo.a[i++]; | 974 | channel <= IEEE80211_52GHZ_MAX_CHANNEL; channel++) { |
| 975 | chan = &geo->a[i++]; | ||
| 972 | chan->freq = bcm43xx_channel_to_freq_a(channel); | 976 | chan->freq = bcm43xx_channel_to_freq_a(channel); |
| 973 | chan->channel = channel; | 977 | chan->channel = channel; |
| 974 | } | 978 | } |
| 975 | geo.a_channels = i; | 979 | geo->a_channels = i; |
| 976 | } | 980 | } |
| 977 | if (have_bg) { | 981 | if (have_bg) { |
| 978 | for (i = 0, channel = 1; channel < 15; channel++) { | 982 | for (i = 0, channel = IEEE80211_24GHZ_MIN_CHANNEL; |
| 979 | chan = &geo.bg[i++]; | 983 | channel <= IEEE80211_24GHZ_MAX_CHANNEL; channel++) { |
| 984 | chan = &geo->bg[i++]; | ||
| 980 | chan->freq = bcm43xx_channel_to_freq_bg(channel); | 985 | chan->freq = bcm43xx_channel_to_freq_bg(channel); |
| 981 | chan->channel = channel; | 986 | chan->channel = channel; |
| 982 | } | 987 | } |
| 983 | geo.bg_channels = i; | 988 | geo->bg_channels = i; |
| 984 | } | 989 | } |
| 985 | memcpy(geo.name, iso_country, 2); | 990 | memcpy(geo->name, iso_country, 2); |
| 986 | if (0 /*TODO: Outdoor use only */) | 991 | if (0 /*TODO: Outdoor use only */) |
| 987 | geo.name[2] = 'O'; | 992 | geo->name[2] = 'O'; |
| 988 | else if (0 /*TODO: Indoor use only */) | 993 | else if (0 /*TODO: Indoor use only */) |
| 989 | geo.name[2] = 'I'; | 994 | geo->name[2] = 'I'; |
| 990 | else | 995 | else |
| 991 | geo.name[2] = ' '; | 996 | geo->name[2] = ' '; |
| 992 | geo.name[3] = '\0'; | 997 | geo->name[3] = '\0'; |
| 998 | |||
| 999 | ieee80211_set_geo(bcm->ieee, geo); | ||
| 1000 | kfree(geo); | ||
| 993 | 1001 | ||
| 994 | ieee80211_set_geo(bcm->ieee, &geo); | 1002 | return 0; |
| 995 | } | 1003 | } |
| 996 | 1004 | ||
| 997 | /* DummyTransmission function, as documented on | 1005 | /* DummyTransmission function, as documented on |
| @@ -3263,6 +3271,9 @@ static int bcm43xx_init_board(struct bcm43xx_private *bcm) | |||
| 3263 | bcm43xx_sysfs_register(bcm); | 3271 | bcm43xx_sysfs_register(bcm); |
| 3264 | //FIXME: check for bcm43xx_sysfs_register failure. This function is a bit messy regarding unwinding, though... | 3272 | //FIXME: check for bcm43xx_sysfs_register failure. This function is a bit messy regarding unwinding, though... |
| 3265 | 3273 | ||
| 3274 | /*FIXME: This should be handled by softmac instead. */ | ||
| 3275 | schedule_work(&bcm->softmac->associnfo.work); | ||
| 3276 | |||
| 3266 | assert(err == 0); | 3277 | assert(err == 0); |
| 3267 | out: | 3278 | out: |
| 3268 | return err; | 3279 | return err; |
| @@ -3479,16 +3490,17 @@ static int bcm43xx_attach_board(struct bcm43xx_private *bcm) | |||
| 3479 | goto err_80211_unwind; | 3490 | goto err_80211_unwind; |
| 3480 | bcm43xx_wireless_core_disable(bcm); | 3491 | bcm43xx_wireless_core_disable(bcm); |
| 3481 | } | 3492 | } |
| 3493 | err = bcm43xx_geo_init(bcm); | ||
| 3494 | if (err) | ||
| 3495 | goto err_80211_unwind; | ||
| 3482 | bcm43xx_pctl_set_crystal(bcm, 0); | 3496 | bcm43xx_pctl_set_crystal(bcm, 0); |
| 3483 | 3497 | ||
| 3484 | /* Set the MAC address in the networking subsystem */ | 3498 | /* Set the MAC address in the networking subsystem */ |
| 3485 | if (bcm43xx_current_phy(bcm)->type == BCM43xx_PHYTYPE_A) | 3499 | if (is_valid_ether_addr(bcm->sprom.et1macaddr)) |
| 3486 | memcpy(bcm->net_dev->dev_addr, bcm->sprom.et1macaddr, 6); | 3500 | memcpy(bcm->net_dev->dev_addr, bcm->sprom.et1macaddr, 6); |
| 3487 | else | 3501 | else |
| 3488 | memcpy(bcm->net_dev->dev_addr, bcm->sprom.il0macaddr, 6); | 3502 | memcpy(bcm->net_dev->dev_addr, bcm->sprom.il0macaddr, 6); |
| 3489 | 3503 | ||
| 3490 | bcm43xx_geo_init(bcm); | ||
| 3491 | |||
| 3492 | snprintf(bcm->nick, IW_ESSID_MAX_SIZE, | 3504 | snprintf(bcm->nick, IW_ESSID_MAX_SIZE, |
| 3493 | "Broadcom %04X", bcm->chip_id); | 3505 | "Broadcom %04X", bcm->chip_id); |
| 3494 | 3506 | ||
| @@ -3937,9 +3949,6 @@ static int bcm43xx_resume(struct pci_dev *pdev) | |||
| 3937 | 3949 | ||
| 3938 | netif_device_attach(net_dev); | 3950 | netif_device_attach(net_dev); |
| 3939 | 3951 | ||
| 3940 | /*FIXME: This should be handled by softmac instead. */ | ||
| 3941 | schedule_work(&bcm->softmac->associnfo.work); | ||
| 3942 | |||
| 3943 | dprintk(KERN_INFO PFX "Device resumed.\n"); | 3952 | dprintk(KERN_INFO PFX "Device resumed.\n"); |
| 3944 | 3953 | ||
| 3945 | return 0; | 3954 | return 0; |
diff --git a/drivers/net/wireless/bcm43xx/bcm43xx_main.h b/drivers/net/wireless/bcm43xx/bcm43xx_main.h index eca79a38594a..30a202b258b5 100644 --- a/drivers/net/wireless/bcm43xx/bcm43xx_main.h +++ b/drivers/net/wireless/bcm43xx/bcm43xx_main.h | |||
| @@ -118,12 +118,14 @@ int bcm43xx_channel_to_freq(struct bcm43xx_private *bcm, | |||
| 118 | static inline | 118 | static inline |
| 119 | int bcm43xx_is_valid_channel_a(u8 channel) | 119 | int bcm43xx_is_valid_channel_a(u8 channel) |
| 120 | { | 120 | { |
| 121 | return (channel <= 200); | 121 | return (channel >= IEEE80211_52GHZ_MIN_CHANNEL |
| 122 | && channel <= IEEE80211_52GHZ_MAX_CHANNEL); | ||
| 122 | } | 123 | } |
| 123 | static inline | 124 | static inline |
| 124 | int bcm43xx_is_valid_channel_bg(u8 channel) | 125 | int bcm43xx_is_valid_channel_bg(u8 channel) |
| 125 | { | 126 | { |
| 126 | return (channel >= 1 && channel <= 14); | 127 | return (channel >= IEEE80211_24GHZ_MIN_CHANNEL |
| 128 | && channel <= IEEE80211_24GHZ_MAX_CHANNEL); | ||
| 127 | } | 129 | } |
| 128 | static inline | 130 | static inline |
| 129 | int bcm43xx_is_valid_channel(struct bcm43xx_private *bcm, | 131 | int bcm43xx_is_valid_channel(struct bcm43xx_private *bcm, |
diff --git a/drivers/net/wireless/bcm43xx/bcm43xx_phy.c b/drivers/net/wireless/bcm43xx/bcm43xx_phy.c index 33137165727f..b0abac515530 100644 --- a/drivers/net/wireless/bcm43xx/bcm43xx_phy.c +++ b/drivers/net/wireless/bcm43xx/bcm43xx_phy.c | |||
| @@ -1287,7 +1287,7 @@ static void bcm43xx_phy_initg(struct bcm43xx_private *bcm) | |||
| 1287 | if (radio->revision == 8) | 1287 | if (radio->revision == 8) |
| 1288 | bcm43xx_phy_write(bcm, 0x0805, 0x3230); | 1288 | bcm43xx_phy_write(bcm, 0x0805, 0x3230); |
| 1289 | bcm43xx_phy_init_pctl(bcm); | 1289 | bcm43xx_phy_init_pctl(bcm); |
| 1290 | if (bcm->chip_id == 0x4306 && bcm->chip_package != 2) { | 1290 | if (bcm->chip_id == 0x4306 && bcm->chip_package == 2) { |
| 1291 | bcm43xx_phy_write(bcm, 0x0429, | 1291 | bcm43xx_phy_write(bcm, 0x0429, |
| 1292 | bcm43xx_phy_read(bcm, 0x0429) & 0xBFFF); | 1292 | bcm43xx_phy_read(bcm, 0x0429) & 0xBFFF); |
| 1293 | bcm43xx_phy_write(bcm, 0x04C3, | 1293 | bcm43xx_phy_write(bcm, 0x04C3, |
diff --git a/drivers/net/wireless/bcm43xx/bcm43xx_wx.c b/drivers/net/wireless/bcm43xx/bcm43xx_wx.c index 3edbb481a0a0..b45063974ae9 100644 --- a/drivers/net/wireless/bcm43xx/bcm43xx_wx.c +++ b/drivers/net/wireless/bcm43xx/bcm43xx_wx.c | |||
| @@ -182,8 +182,11 @@ static int bcm43xx_wx_set_mode(struct net_device *net_dev, | |||
| 182 | mode = BCM43xx_INITIAL_IWMODE; | 182 | mode = BCM43xx_INITIAL_IWMODE; |
| 183 | 183 | ||
| 184 | bcm43xx_lock_mmio(bcm, flags); | 184 | bcm43xx_lock_mmio(bcm, flags); |
| 185 | if (bcm->ieee->iw_mode != mode) | 185 | if (bcm->initialized) { |
| 186 | bcm43xx_set_iwmode(bcm, mode); | 186 | if (bcm->ieee->iw_mode != mode) |
| 187 | bcm43xx_set_iwmode(bcm, mode); | ||
| 188 | } else | ||
| 189 | bcm->ieee->iw_mode = mode; | ||
| 187 | bcm43xx_unlock_mmio(bcm, flags); | 190 | bcm43xx_unlock_mmio(bcm, flags); |
| 188 | 191 | ||
| 189 | return 0; | 192 | return 0; |
diff --git a/drivers/net/wireless/orinoco.c b/drivers/net/wireless/orinoco.c index 06523e2a8471..c2d0b09e0418 100644 --- a/drivers/net/wireless/orinoco.c +++ b/drivers/net/wireless/orinoco.c | |||
| @@ -812,7 +812,6 @@ static void orinoco_rx_monitor(struct net_device *dev, u16 rxfid, | |||
| 812 | if (datalen > IEEE80211_DATA_LEN + 12) { | 812 | if (datalen > IEEE80211_DATA_LEN + 12) { |
| 813 | printk(KERN_DEBUG "%s: oversized monitor frame, " | 813 | printk(KERN_DEBUG "%s: oversized monitor frame, " |
| 814 | "data length = %d\n", dev->name, datalen); | 814 | "data length = %d\n", dev->name, datalen); |
| 815 | err = -EIO; | ||
| 816 | stats->rx_length_errors++; | 815 | stats->rx_length_errors++; |
| 817 | goto update_stats; | 816 | goto update_stats; |
| 818 | } | 817 | } |
| @@ -821,8 +820,7 @@ static void orinoco_rx_monitor(struct net_device *dev, u16 rxfid, | |||
| 821 | if (!skb) { | 820 | if (!skb) { |
| 822 | printk(KERN_WARNING "%s: Cannot allocate skb for monitor frame\n", | 821 | printk(KERN_WARNING "%s: Cannot allocate skb for monitor frame\n", |
| 823 | dev->name); | 822 | dev->name); |
| 824 | err = -ENOMEM; | 823 | goto update_stats; |
| 825 | goto drop; | ||
| 826 | } | 824 | } |
| 827 | 825 | ||
| 828 | /* Copy the 802.11 header to the skb */ | 826 | /* Copy the 802.11 header to the skb */ |
