Manual merge with Linus.
[linux-2.6] / drivers / net / ibm_emac / ibm_emac_rgmii.c
1 /*
2  * drivers/net/ibm_emac/ibm_emac_rgmii.c
3  *
4  * Driver for PowerPC 4xx on-chip ethernet controller, RGMII 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  *      Matt Porter <mporter@kernel.crashing.org>
11  *      Copyright 2004 MontaVista Software, 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 /* RGMIIx_FER */
28 #define RGMII_FER_MASK(idx)     (0x7 << ((idx) * 4))
29 #define RGMII_FER_RTBI(idx)     (0x4 << ((idx) * 4))
30 #define RGMII_FER_RGMII(idx)    (0x5 << ((idx) * 4))
31 #define RGMII_FER_TBI(idx)      (0x6 << ((idx) * 4))
32 #define RGMII_FER_GMII(idx)     (0x7 << ((idx) * 4))
33
34 /* RGMIIx_SSR */
35 #define RGMII_SSR_MASK(idx)     (0x7 << ((idx) * 8))
36 #define RGMII_SSR_100(idx)      (0x2 << ((idx) * 8))
37 #define RGMII_SSR_1000(idx)     (0x4 << ((idx) * 8))
38
39 /* RGMII bridge supports only GMII/TBI and RGMII/RTBI PHYs */
40 static inline int rgmii_valid_mode(int phy_mode)
41 {
42         return  phy_mode == PHY_MODE_GMII ||
43                 phy_mode == PHY_MODE_RGMII ||
44                 phy_mode == PHY_MODE_TBI ||
45                 phy_mode == PHY_MODE_RTBI;
46 }
47
48 static inline const char *rgmii_mode_name(int mode)
49 {
50         switch (mode) {
51         case PHY_MODE_RGMII:
52                 return "RGMII";
53         case PHY_MODE_TBI:
54                 return "TBI";
55         case PHY_MODE_GMII:
56                 return "GMII";
57         case PHY_MODE_RTBI:
58                 return "RTBI";
59         default:
60                 BUG();
61         }
62 }
63
64 static inline u32 rgmii_mode_mask(int mode, int input)
65 {
66         switch (mode) {
67         case PHY_MODE_RGMII:
68                 return RGMII_FER_RGMII(input);
69         case PHY_MODE_TBI:
70                 return RGMII_FER_TBI(input);
71         case PHY_MODE_GMII:
72                 return RGMII_FER_GMII(input);
73         case PHY_MODE_RTBI:
74                 return RGMII_FER_RTBI(input);
75         default:
76                 BUG();
77         }
78 }
79
80 static int __init rgmii_init(struct ocp_device *ocpdev, int input, int mode)
81 {
82         struct ibm_ocp_rgmii *dev = ocp_get_drvdata(ocpdev);
83         struct rgmii_regs *p;
84
85         RGMII_DBG("%d: init(%d, %d)" NL, ocpdev->def->index, input, mode);
86
87         if (!dev) {
88                 dev = kzalloc(sizeof(struct ibm_ocp_rgmii), GFP_KERNEL);
89                 if (!dev) {
90                         printk(KERN_ERR
91                                "rgmii%d: couldn't allocate device structure!\n",
92                                ocpdev->def->index);
93                         return -ENOMEM;
94                 }
95
96                 p = (struct rgmii_regs *)ioremap(ocpdev->def->paddr,
97                                                  sizeof(struct rgmii_regs));
98                 if (!p) {
99                         printk(KERN_ERR
100                                "rgmii%d: could not ioremap device registers!\n",
101                                ocpdev->def->index);
102                         kfree(dev);
103                         return -ENOMEM;
104                 }
105
106                 dev->base = p;
107                 ocp_set_drvdata(ocpdev, dev);
108
109                 /* Disable all inputs by default */
110                 out_be32(&p->fer, 0);
111         } else
112                 p = dev->base;
113
114         /* Enable this input */
115         out_be32(&p->fer, in_be32(&p->fer) | rgmii_mode_mask(mode, input));
116
117         printk(KERN_NOTICE "rgmii%d: input %d in %s mode\n",
118                ocpdev->def->index, input, rgmii_mode_name(mode));
119
120         ++dev->users;
121         return 0;
122 }
123
124 int __init rgmii_attach(void *emac)
125 {
126         struct ocp_enet_private *dev = emac;
127         struct ocp_func_emac_data *emacdata = dev->def->additions;
128
129         /* Check if we need to attach to a RGMII */
130         if (emacdata->rgmii_idx >= 0 && rgmii_valid_mode(emacdata->phy_mode)) {
131                 dev->rgmii_input = emacdata->rgmii_mux;
132                 dev->rgmii_dev =
133                     ocp_find_device(OCP_VENDOR_IBM, OCP_FUNC_RGMII,
134                                     emacdata->rgmii_idx);
135                 if (!dev->rgmii_dev) {
136                         printk(KERN_ERR "emac%d: unknown rgmii%d!\n",
137                                dev->def->index, emacdata->rgmii_idx);
138                         return -ENODEV;
139                 }
140                 if (rgmii_init
141                     (dev->rgmii_dev, dev->rgmii_input, emacdata->phy_mode)) {
142                         printk(KERN_ERR
143                                "emac%d: rgmii%d initialization failed!\n",
144                                dev->def->index, emacdata->rgmii_idx);
145                         return -ENODEV;
146                 }
147         }
148         return 0;
149 }
150
151 void rgmii_set_speed(struct ocp_device *ocpdev, int input, int speed)
152 {
153         struct ibm_ocp_rgmii *dev = ocp_get_drvdata(ocpdev);
154         u32 ssr = in_be32(&dev->base->ssr) & ~RGMII_SSR_MASK(input);
155
156         RGMII_DBG("%d: speed(%d, %d)" NL, ocpdev->def->index, input, speed);
157
158         if (speed == SPEED_1000)
159                 ssr |= RGMII_SSR_1000(input);
160         else if (speed == SPEED_100)
161                 ssr |= RGMII_SSR_100(input);
162
163         out_be32(&dev->base->ssr, ssr);
164 }
165
166 void __exit __rgmii_fini(struct ocp_device *ocpdev, int input)
167 {
168         struct ibm_ocp_rgmii *dev = ocp_get_drvdata(ocpdev);
169         BUG_ON(!dev || dev->users == 0);
170
171         RGMII_DBG("%d: fini(%d)" NL, ocpdev->def->index, input);
172
173         /* Disable this input */
174         out_be32(&dev->base->fer,
175                  in_be32(&dev->base->fer) & ~RGMII_FER_MASK(input));
176
177         if (!--dev->users) {
178                 /* Free everything if this is the last user */
179                 ocp_set_drvdata(ocpdev, NULL);
180                 iounmap((void *)dev->base);
181                 kfree(dev);
182         }
183 }
184
185 int __rgmii_get_regs_len(struct ocp_device *ocpdev)
186 {
187         return sizeof(struct emac_ethtool_regs_subhdr) +
188             sizeof(struct rgmii_regs);
189 }
190
191 void *rgmii_dump_regs(struct ocp_device *ocpdev, void *buf)
192 {
193         struct ibm_ocp_rgmii *dev = ocp_get_drvdata(ocpdev);
194         struct emac_ethtool_regs_subhdr *hdr = buf;
195         struct rgmii_regs *regs = (struct rgmii_regs *)(hdr + 1);
196
197         hdr->version = 0;
198         hdr->index = ocpdev->def->index;
199         memcpy_fromio(regs, dev->base, sizeof(struct rgmii_regs));
200         return regs + 1;
201 }