c724fc36a24fd696557c32afc87f0cdc6835ba0c
[linux-3.10.git] / drivers / net / stmmac / dwmac100_core.c
1 /*******************************************************************************
2   This is the driver for the MAC 10/100 on-chip Ethernet controller
3   currently tested on all the ST boards based on STb7109 and stx7200 SoCs.
4
5   DWC Ether MAC 10/100 Universal version 4.0 has been used for developing
6   this code.
7
8   This only implements the mac core functions for this chip.
9
10   Copyright (C) 2007-2009  STMicroelectronics Ltd
11
12   This program is free software; you can redistribute it and/or modify it
13   under the terms and conditions of the GNU General Public License,
14   version 2, as published by the Free Software Foundation.
15
16   This program is distributed in the hope it will be useful, but WITHOUT
17   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
18   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
19   more details.
20
21   You should have received a copy of the GNU General Public License along with
22   this program; if not, write to the Free Software Foundation, Inc.,
23   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
24
25   The full GNU General Public License is included in this distribution in
26   the file called "COPYING".
27
28   Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
29 *******************************************************************************/
30
31 #include <linux/crc32.h>
32 #include "dwmac100.h"
33
34 static void dwmac100_core_init(void __iomem *ioaddr)
35 {
36         u32 value = readl(ioaddr + MAC_CONTROL);
37
38         writel((value | MAC_CORE_INIT), ioaddr + MAC_CONTROL);
39
40 #ifdef STMMAC_VLAN_TAG_USED
41         writel(ETH_P_8021Q, ioaddr + MAC_VLAN1);
42 #endif
43 }
44
45 static int dwmac100_rx_coe_supported(void __iomem *ioaddr)
46 {
47         return 0;
48 }
49
50 static void dwmac100_dump_mac_regs(void __iomem *ioaddr)
51 {
52         pr_info("\t----------------------------------------------\n"
53                 "\t  DWMAC 100 CSR (base addr = 0x%p)\n"
54                 "\t----------------------------------------------\n",
55                 ioaddr);
56         pr_info("\tcontrol reg (offset 0x%x): 0x%08x\n", MAC_CONTROL,
57                 readl(ioaddr + MAC_CONTROL));
58         pr_info("\taddr HI (offset 0x%x): 0x%08x\n ", MAC_ADDR_HIGH,
59                 readl(ioaddr + MAC_ADDR_HIGH));
60         pr_info("\taddr LO (offset 0x%x): 0x%08x\n", MAC_ADDR_LOW,
61                 readl(ioaddr + MAC_ADDR_LOW));
62         pr_info("\tmulticast hash HI (offset 0x%x): 0x%08x\n",
63                 MAC_HASH_HIGH, readl(ioaddr + MAC_HASH_HIGH));
64         pr_info("\tmulticast hash LO (offset 0x%x): 0x%08x\n",
65                 MAC_HASH_LOW, readl(ioaddr + MAC_HASH_LOW));
66         pr_info("\tflow control (offset 0x%x): 0x%08x\n",
67                 MAC_FLOW_CTRL, readl(ioaddr + MAC_FLOW_CTRL));
68         pr_info("\tVLAN1 tag (offset 0x%x): 0x%08x\n", MAC_VLAN1,
69                 readl(ioaddr + MAC_VLAN1));
70         pr_info("\tVLAN2 tag (offset 0x%x): 0x%08x\n", MAC_VLAN2,
71                 readl(ioaddr + MAC_VLAN2));
72         pr_info("\n\tMAC management counter registers\n");
73         pr_info("\t MMC crtl (offset 0x%x): 0x%08x\n",
74                 MMC_CONTROL, readl(ioaddr + MMC_CONTROL));
75         pr_info("\t MMC High Interrupt (offset 0x%x): 0x%08x\n",
76                 MMC_HIGH_INTR, readl(ioaddr + MMC_HIGH_INTR));
77         pr_info("\t MMC Low Interrupt (offset 0x%x): 0x%08x\n",
78                 MMC_LOW_INTR, readl(ioaddr + MMC_LOW_INTR));
79         pr_info("\t MMC High Interrupt Mask (offset 0x%x): 0x%08x\n",
80                 MMC_HIGH_INTR_MASK, readl(ioaddr + MMC_HIGH_INTR_MASK));
81         pr_info("\t MMC Low Interrupt Mask (offset 0x%x): 0x%08x\n",
82                 MMC_LOW_INTR_MASK, readl(ioaddr + MMC_LOW_INTR_MASK));
83 }
84
85 static void dwmac100_irq_status(void __iomem *ioaddr)
86 {
87         return;
88 }
89
90 static void dwmac100_set_umac_addr(void __iomem *ioaddr, unsigned char *addr,
91                                    unsigned int reg_n)
92 {
93         stmmac_set_mac_addr(ioaddr, addr, MAC_ADDR_HIGH, MAC_ADDR_LOW);
94 }
95
96 static void dwmac100_get_umac_addr(void __iomem *ioaddr, unsigned char *addr,
97                                    unsigned int reg_n)
98 {
99         stmmac_get_mac_addr(ioaddr, addr, MAC_ADDR_HIGH, MAC_ADDR_LOW);
100 }
101
102 static void dwmac100_set_filter(struct net_device *dev)
103 {
104         void __iomem *ioaddr = (void __iomem *) dev->base_addr;
105         u32 value = readl(ioaddr + MAC_CONTROL);
106
107         if (dev->flags & IFF_PROMISC) {
108                 value |= MAC_CONTROL_PR;
109                 value &= ~(MAC_CONTROL_PM | MAC_CONTROL_IF | MAC_CONTROL_HO |
110                            MAC_CONTROL_HP);
111         } else if ((netdev_mc_count(dev) > HASH_TABLE_SIZE)
112                    || (dev->flags & IFF_ALLMULTI)) {
113                 value |= MAC_CONTROL_PM;
114                 value &= ~(MAC_CONTROL_PR | MAC_CONTROL_IF | MAC_CONTROL_HO);
115                 writel(0xffffffff, ioaddr + MAC_HASH_HIGH);
116                 writel(0xffffffff, ioaddr + MAC_HASH_LOW);
117         } else if (netdev_mc_empty(dev)) {      /* no multicast */
118                 value &= ~(MAC_CONTROL_PM | MAC_CONTROL_PR | MAC_CONTROL_IF |
119                            MAC_CONTROL_HO | MAC_CONTROL_HP);
120         } else {
121                 u32 mc_filter[2];
122                 struct netdev_hw_addr *ha;
123
124                 /* Perfect filter mode for physical address and Hash
125                    filter for multicast */
126                 value |= MAC_CONTROL_HP;
127                 value &= ~(MAC_CONTROL_PM | MAC_CONTROL_PR |
128                            MAC_CONTROL_IF | MAC_CONTROL_HO);
129
130                 memset(mc_filter, 0, sizeof(mc_filter));
131                 netdev_for_each_mc_addr(ha, dev) {
132                         /* The upper 6 bits of the calculated CRC are used to
133                          * index the contens of the hash table */
134                         int bit_nr =
135                             ether_crc(ETH_ALEN, ha->addr) >> 26;
136                         /* The most significant bit determines the register to
137                          * use (H/L) while the other 5 bits determine the bit
138                          * within the register. */
139                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
140                 }
141                 writel(mc_filter[0], ioaddr + MAC_HASH_LOW);
142                 writel(mc_filter[1], ioaddr + MAC_HASH_HIGH);
143         }
144
145         writel(value, ioaddr + MAC_CONTROL);
146
147         CHIP_DBG(KERN_INFO "%s: CTRL reg: 0x%08x Hash regs: "
148             "HI 0x%08x, LO 0x%08x\n",
149             __func__, readl(ioaddr + MAC_CONTROL),
150             readl(ioaddr + MAC_HASH_HIGH), readl(ioaddr + MAC_HASH_LOW));
151 }
152
153 static void dwmac100_flow_ctrl(void __iomem *ioaddr, unsigned int duplex,
154                                unsigned int fc, unsigned int pause_time)
155 {
156         unsigned int flow = MAC_FLOW_CTRL_ENABLE;
157
158         if (duplex)
159                 flow |= (pause_time << MAC_FLOW_CTRL_PT_SHIFT);
160         writel(flow, ioaddr + MAC_FLOW_CTRL);
161 }
162
163 /* No PMT module supported for this Ethernet Controller.
164  * Tested on ST platforms only.
165  */
166 static void dwmac100_pmt(void __iomem *ioaddr, unsigned long mode)
167 {
168         return;
169 }
170
171 static const struct stmmac_ops dwmac100_ops = {
172         .core_init = dwmac100_core_init,
173         .rx_coe = dwmac100_rx_coe_supported,
174         .dump_regs = dwmac100_dump_mac_regs,
175         .host_irq_status = dwmac100_irq_status,
176         .set_filter = dwmac100_set_filter,
177         .flow_ctrl = dwmac100_flow_ctrl,
178         .pmt = dwmac100_pmt,
179         .set_umac_addr = dwmac100_set_umac_addr,
180         .get_umac_addr = dwmac100_get_umac_addr,
181 };
182
183 struct mac_device_info *dwmac100_setup(void __iomem *ioaddr)
184 {
185         struct mac_device_info *mac;
186
187         mac = kzalloc(sizeof(const struct mac_device_info), GFP_KERNEL);
188         if (!mac)
189                 return NULL;
190
191         pr_info("\tDWMAC100\n");
192
193         mac->mac = &dwmac100_ops;
194         mac->dma = &dwmac100_dma_ops;
195
196         mac->link.port = MAC_CONTROL_PS;
197         mac->link.duplex = MAC_CONTROL_F;
198         mac->link.speed = 0;
199         mac->mii.addr = MAC_MII_ADDR;
200         mac->mii.data = MAC_MII_DATA;
201
202         return mac;
203 }