Merge branch 'srp' of master.kernel.org:/pub/scm/linux/kernel/git/roland/infiniband
[linux-2.6] / drivers / net / ibm_emac / ibm_emac_zmii.c
1 /*
2  * drivers/net/ibm_emac/ibm_emac_zmii.c
3  *
4  * Driver for PowerPC 4xx on-chip ethernet controller, ZMII bridge support.
5  *
6  * Copyright (c) 2004, 2005 Zultys Technologies.
7  * Eugene Surovegin <eugene.surovegin@zultys.com> or <ebs@ebshome.net>
8  *
9  * Based on original work by
10  *      Armin Kuster <akuster@mvista.com>
11  *      Copyright 2001 MontaVista Softare Inc.
12  *
13  * This program is free software; you can redistribute  it and/or modify it
14  * under  the terms of  the GNU General  Public License as published by the
15  * Free Software Foundation;  either version 2 of the  License, or (at your
16  * option) any later version.
17  *
18  */
19 #include <linux/config.h>
20 #include <linux/kernel.h>
21 #include <linux/ethtool.h>
22 #include <asm/io.h>
23
24 #include "ibm_emac_core.h"
25 #include "ibm_emac_debug.h"
26
27 /* ZMIIx_FER */
28 #define ZMII_FER_MDI(idx)       (0x80000000 >> ((idx) * 4))
29 #define ZMII_FER_MDI_ALL        (ZMII_FER_MDI(0) | ZMII_FER_MDI(1) | \
30                                  ZMII_FER_MDI(2) | ZMII_FER_MDI(3))
31
32 #define ZMII_FER_SMII(idx)      (0x40000000 >> ((idx) * 4))
33 #define ZMII_FER_RMII(idx)      (0x20000000 >> ((idx) * 4))
34 #define ZMII_FER_MII(idx)       (0x10000000 >> ((idx) * 4))
35
36 /* ZMIIx_SSR */
37 #define ZMII_SSR_SCI(idx)       (0x40000000 >> ((idx) * 4))
38 #define ZMII_SSR_FSS(idx)       (0x20000000 >> ((idx) * 4))
39 #define ZMII_SSR_SP(idx)        (0x10000000 >> ((idx) * 4))
40
41 /* ZMII only supports MII, RMII and SMII 
42  * we also support autodetection for backward compatibility
43  */
44 static inline int zmii_valid_mode(int mode)
45 {
46         return  mode == PHY_MODE_MII ||
47                 mode == PHY_MODE_RMII ||
48                 mode == PHY_MODE_SMII ||
49                 mode == PHY_MODE_NA;
50 }
51
52 static inline const char *zmii_mode_name(int mode)
53 {
54         switch (mode) {
55         case PHY_MODE_MII:
56                 return "MII";
57         case PHY_MODE_RMII:
58                 return "RMII";
59         case PHY_MODE_SMII:
60                 return "SMII";
61         default:
62                 BUG();
63         }
64 }
65
66 static inline u32 zmii_mode_mask(int mode, int input)
67 {
68         switch (mode) {
69         case PHY_MODE_MII:
70                 return ZMII_FER_MII(input);
71         case PHY_MODE_RMII:
72                 return ZMII_FER_RMII(input);
73         case PHY_MODE_SMII:
74                 return ZMII_FER_SMII(input);
75         default:
76                 return 0;
77         }
78 }
79
80 static int __init zmii_init(struct ocp_device *ocpdev, int input, int *mode)
81 {
82         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
83         struct zmii_regs *p;
84
85         ZMII_DBG("%d: init(%d, %d)" NL, ocpdev->def->index, input, *mode);
86
87         if (!dev) {
88                 dev = kzalloc(sizeof(struct ibm_ocp_zmii), GFP_KERNEL);
89                 if (!dev) {
90                         printk(KERN_ERR
91                                "zmii%d: couldn't allocate device structure!\n",
92                                ocpdev->def->index);
93                         return -ENOMEM;
94                 }
95                 dev->mode = PHY_MODE_NA;
96
97                 p = (struct zmii_regs *)ioremap(ocpdev->def->paddr,
98                                                 sizeof(struct zmii_regs));
99                 if (!p) {
100                         printk(KERN_ERR
101                                "zmii%d: could not ioremap device registers!\n",
102                                ocpdev->def->index);
103                         kfree(dev);
104                         return -ENOMEM;
105                 }
106                 dev->base = p;
107                 ocp_set_drvdata(ocpdev, dev);
108                 
109                 /* We may need FER value for autodetection later */
110                 dev->fer_save = in_be32(&p->fer);
111
112                 /* Disable all inputs by default */
113                 out_be32(&p->fer, 0);
114         } else
115                 p = dev->base;
116
117         if (!zmii_valid_mode(*mode)) {
118                 /* Probably an EMAC connected to RGMII, 
119                  * but it still may need ZMII for MDIO 
120                  */
121                 goto out;
122         }
123
124         /* Autodetect ZMII mode if not specified.
125          * This is only for backward compatibility with the old driver.
126          * Please, always specify PHY mode in your board port to avoid
127          * any surprises.
128          */
129         if (dev->mode == PHY_MODE_NA) {
130                 if (*mode == PHY_MODE_NA) {
131                         u32 r = dev->fer_save;
132
133                         ZMII_DBG("%d: autodetecting mode, FER = 0x%08x" NL,
134                                  ocpdev->def->index, r);
135                         
136                         if (r & (ZMII_FER_MII(0) | ZMII_FER_MII(1)))
137                                 dev->mode = PHY_MODE_MII;
138                         else if (r & (ZMII_FER_RMII(0) | ZMII_FER_RMII(1)))
139                                 dev->mode = PHY_MODE_RMII;
140                         else
141                                 dev->mode = PHY_MODE_SMII;
142                 } else
143                         dev->mode = *mode;
144
145                 printk(KERN_NOTICE "zmii%d: bridge in %s mode\n",
146                        ocpdev->def->index, zmii_mode_name(dev->mode));
147         } else {
148                 /* All inputs must use the same mode */
149                 if (*mode != PHY_MODE_NA && *mode != dev->mode) {
150                         printk(KERN_ERR
151                                "zmii%d: invalid mode %d specified for input %d\n",
152                                ocpdev->def->index, *mode, input);
153                         return -EINVAL;
154                 }
155         }
156
157         /* Report back correct PHY mode, 
158          * it may be used during PHY initialization.
159          */
160         *mode = dev->mode;
161
162         /* Enable this input */
163         out_be32(&p->fer, in_be32(&p->fer) | zmii_mode_mask(dev->mode, input));
164       out:
165         ++dev->users;
166         return 0;
167 }
168
169 int __init zmii_attach(void *emac)
170 {
171         struct ocp_enet_private *dev = emac;
172         struct ocp_func_emac_data *emacdata = dev->def->additions;
173
174         if (emacdata->zmii_idx >= 0) {
175                 dev->zmii_input = emacdata->zmii_mux;
176                 dev->zmii_dev =
177                     ocp_find_device(OCP_VENDOR_IBM, OCP_FUNC_ZMII,
178                                     emacdata->zmii_idx);
179                 if (!dev->zmii_dev) {
180                         printk(KERN_ERR "emac%d: unknown zmii%d!\n",
181                                dev->def->index, emacdata->zmii_idx);
182                         return -ENODEV;
183                 }
184                 if (zmii_init
185                     (dev->zmii_dev, dev->zmii_input, &emacdata->phy_mode)) {
186                         printk(KERN_ERR
187                                "emac%d: zmii%d initialization failed!\n",
188                                dev->def->index, emacdata->zmii_idx);
189                         return -ENODEV;
190                 }
191         }
192         return 0;
193 }
194
195 void __zmii_enable_mdio(struct ocp_device *ocpdev, int input)
196 {
197         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
198         u32 fer = in_be32(&dev->base->fer) & ~ZMII_FER_MDI_ALL;
199
200         ZMII_DBG2("%d: mdio(%d)" NL, ocpdev->def->index, input);
201
202         out_be32(&dev->base->fer, fer | ZMII_FER_MDI(input));
203 }
204
205 void __zmii_set_speed(struct ocp_device *ocpdev, int input, int speed)
206 {
207         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
208         u32 ssr = in_be32(&dev->base->ssr);
209
210         ZMII_DBG("%d: speed(%d, %d)" NL, ocpdev->def->index, input, speed);
211
212         if (speed == SPEED_100)
213                 ssr |= ZMII_SSR_SP(input);
214         else
215                 ssr &= ~ZMII_SSR_SP(input);
216
217         out_be32(&dev->base->ssr, ssr);
218 }
219
220 void __exit __zmii_fini(struct ocp_device *ocpdev, int input)
221 {
222         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
223         BUG_ON(!dev || dev->users == 0);
224
225         ZMII_DBG("%d: fini(%d)" NL, ocpdev->def->index, input);
226
227         /* Disable this input */
228         out_be32(&dev->base->fer,
229                  in_be32(&dev->base->fer) & ~zmii_mode_mask(dev->mode, input));
230
231         if (!--dev->users) {
232                 /* Free everything if this is the last user */
233                 ocp_set_drvdata(ocpdev, NULL);
234                 iounmap((void *)dev->base);
235                 kfree(dev);
236         }
237 }
238
239 int __zmii_get_regs_len(struct ocp_device *ocpdev)
240 {
241         return sizeof(struct emac_ethtool_regs_subhdr) +
242             sizeof(struct zmii_regs);
243 }
244
245 void *zmii_dump_regs(struct ocp_device *ocpdev, void *buf)
246 {
247         struct ibm_ocp_zmii *dev = ocp_get_drvdata(ocpdev);
248         struct emac_ethtool_regs_subhdr *hdr = buf;
249         struct zmii_regs *regs = (struct zmii_regs *)(hdr + 1);
250
251         hdr->version = 0;
252         hdr->index = ocpdev->def->index;
253         memcpy_fromio(regs, dev->base, sizeof(struct zmii_regs));
254         return regs + 1;
255 }