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