blob: 4a327ab48f64a4ea5f480c889fc5a203a5624c13 [file] [log] [blame]
Dave Liu7737d5c2006-11-03 12:11:15 -06001/*
2 * Copyright (C) 2006 Freescale Semiconductor, Inc.
3 *
4 * Dave Liu <daveliu@freescale.com>
5 * based on source code of Shlomi Gridish
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 of
10 * the License, or (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
20 * MA 02111-1307 USA
21 */
22
23#include "common.h"
24#include "malloc.h"
25#include "asm/errno.h"
26#include "asm/io.h"
27#include "asm/immap_qe.h"
28#include "qe.h"
29#include "uccf.h"
30
31#if defined(CONFIG_QE)
32void ucc_fast_transmit_on_demand(ucc_fast_private_t *uccf)
33{
34 out_be16(&uccf->uf_regs->utodr, UCC_FAST_TOD);
35}
36
37u32 ucc_fast_get_qe_cr_subblock(int ucc_num)
38{
39 switch (ucc_num) {
40 case 0: return QE_CR_SUBBLOCK_UCCFAST1;
41 case 1: return QE_CR_SUBBLOCK_UCCFAST2;
42 case 2: return QE_CR_SUBBLOCK_UCCFAST3;
43 case 3: return QE_CR_SUBBLOCK_UCCFAST4;
44 case 4: return QE_CR_SUBBLOCK_UCCFAST5;
45 case 5: return QE_CR_SUBBLOCK_UCCFAST6;
46 case 6: return QE_CR_SUBBLOCK_UCCFAST7;
47 case 7: return QE_CR_SUBBLOCK_UCCFAST8;
48 default: return QE_CR_SUBBLOCK_INVALID;
Wolfgang Denkdd520bf2006-11-30 18:02:20 +010049 }
Dave Liu7737d5c2006-11-03 12:11:15 -060050}
51
52static void ucc_get_cmxucr_reg(int ucc_num, volatile u32 **p_cmxucr,
53 u8 *reg_num, u8 *shift)
54{
55 switch (ucc_num) {
56 case 0: /* UCC1 */
57 *p_cmxucr = &(qe_immr->qmx.cmxucr1);
58 *reg_num = 1;
59 *shift = 16;
60 break;
61 case 2: /* UCC3 */
62 *p_cmxucr = &(qe_immr->qmx.cmxucr1);
63 *reg_num = 1;
64 *shift = 0;
65 break;
66 case 4: /* UCC5 */
67 *p_cmxucr = &(qe_immr->qmx.cmxucr2);
68 *reg_num = 2;
69 *shift = 16;
70 break;
71 case 6: /* UCC7 */
72 *p_cmxucr = &(qe_immr->qmx.cmxucr2);
73 *reg_num = 2;
74 *shift = 0;
75 break;
76 case 1: /* UCC2 */
77 *p_cmxucr = &(qe_immr->qmx.cmxucr3);
78 *reg_num = 3;
79 *shift = 16;
80 break;
81 case 3: /* UCC4 */
82 *p_cmxucr = &(qe_immr->qmx.cmxucr3);
83 *reg_num = 3;
84 *shift = 0;
85 break;
86 case 5: /* UCC6 */
87 *p_cmxucr = &(qe_immr->qmx.cmxucr4);
88 *reg_num = 4;
89 *shift = 16;
90 break;
91 case 7: /* UCC8 */
92 *p_cmxucr = &(qe_immr->qmx.cmxucr4);
93 *reg_num = 4;
94 *shift = 0;
95 break;
96 default:
97 break;
98 }
99}
100
101static int ucc_set_clk_src(int ucc_num, qe_clock_e clock, comm_dir_e mode)
102{
Kim Phillips1aa934c2006-11-28 23:28:33 -0600103 volatile u32 *p_cmxucr = NULL;
104 u8 reg_num = 0;
105 u8 shift = 0;
Dave Liu7737d5c2006-11-03 12:11:15 -0600106 u32 clockBits;
107 u32 clockMask;
108 int source = -1;
109
110 /* check if the UCC number is in range. */
111 if ((ucc_num > UCC_MAX_NUM - 1) || (ucc_num < 0))
112 return -EINVAL;
113
114 if (! ((mode == COMM_DIR_RX) || (mode == COMM_DIR_TX))) {
115 printf("%s: bad comm mode type passed\n", __FUNCTION__);
116 return -EINVAL;
117 }
118
119 ucc_get_cmxucr_reg(ucc_num, &p_cmxucr, &reg_num, &shift);
120
121 switch (reg_num) {
122 case 1:
123 switch (clock) {
124 case QE_BRG1: source = 1; break;
125 case QE_BRG2: source = 2; break;
126 case QE_BRG7: source = 3; break;
127 case QE_BRG8: source = 4; break;
128 case QE_CLK9: source = 5; break;
129 case QE_CLK10: source = 6; break;
130 case QE_CLK11: source = 7; break;
131 case QE_CLK12: source = 8; break;
132 case QE_CLK15: source = 9; break;
133 case QE_CLK16: source = 10; break;
134 default: source = -1; break;
135 }
136 break;
137 case 2:
138 switch (clock) {
139 case QE_BRG5: source = 1; break;
140 case QE_BRG6: source = 2; break;
141 case QE_BRG7: source = 3; break;
142 case QE_BRG8: source = 4; break;
143 case QE_CLK13: source = 5; break;
144 case QE_CLK14: source = 6; break;
145 case QE_CLK19: source = 7; break;
146 case QE_CLK20: source = 8; break;
147 case QE_CLK15: source = 9; break;
148 case QE_CLK16: source = 10; break;
149 default: source = -1; break;
150 }
151 break;
152 case 3:
153 switch (clock) {
154 case QE_BRG9: source = 1; break;
155 case QE_BRG10: source = 2; break;
156 case QE_BRG15: source = 3; break;
157 case QE_BRG16: source = 4; break;
158 case QE_CLK3: source = 5; break;
159 case QE_CLK4: source = 6; break;
160 case QE_CLK17: source = 7; break;
161 case QE_CLK18: source = 8; break;
162 case QE_CLK7: source = 9; break;
163 case QE_CLK8: source = 10; break;
164 case QE_CLK16: source = 11; break;
165 default: source = -1; break;
166 }
167 break;
168 case 4:
169 switch (clock) {
170 case QE_BRG13: source = 1; break;
171 case QE_BRG14: source = 2; break;
172 case QE_BRG15: source = 3; break;
173 case QE_BRG16: source = 4; break;
174 case QE_CLK5: source = 5; break;
175 case QE_CLK6: source = 6; break;
176 case QE_CLK21: source = 7; break;
177 case QE_CLK22: source = 8; break;
178 case QE_CLK7: source = 9; break;
179 case QE_CLK8: source = 10; break;
180 case QE_CLK16: source = 11; break;
181 default: source = -1; break;
182 }
183 break;
184 default:
185 source = -1;
186 break;
187 }
188
189 if (source == -1) {
190 printf("%s: Bad combination of clock and UCC\n", __FUNCTION__);
191 return -ENOENT;
192 }
193
194 clockBits = (u32) source;
195 clockMask = QE_CMXUCR_TX_CLK_SRC_MASK;
196 if (mode == COMM_DIR_RX) {
197 clockBits <<= 4; /* Rx field is 4 bits to left of Tx field */
198 clockMask <<= 4; /* Rx field is 4 bits to left of Tx field */
199 }
200 clockBits <<= shift;
201 clockMask <<= shift;
202
203 out_be32(p_cmxucr, (in_be32(p_cmxucr) & ~clockMask) | clockBits);
204
205 return 0;
206}
207
208static uint ucc_get_reg_baseaddr(int ucc_num)
209{
210 uint base = 0;
211
212 /* check if the UCC number is in range */
213 if ((ucc_num > UCC_MAX_NUM - 1) || (ucc_num < 0)) {
214 printf("%s: the UCC num not in ranges\n", __FUNCTION__);
215 return 0;
216 }
217
218 switch (ucc_num) {
219 case 0: base = 0x00002000; break;
220 case 1: base = 0x00003000; break;
221 case 2: base = 0x00002200; break;
222 case 3: base = 0x00003200; break;
223 case 4: base = 0x00002400; break;
224 case 5: base = 0x00003400; break;
225 case 6: base = 0x00002600; break;
226 case 7: base = 0x00003600; break;
227 default: break;
228 }
229
230 base = (uint)qe_immr + base;
231 return base;
232}
233
234void ucc_fast_enable(ucc_fast_private_t *uccf, comm_dir_e mode)
235{
236 ucc_fast_t *uf_regs;
237 u32 gumr;
238
239 uf_regs = uccf->uf_regs;
240
241 /* Enable reception and/or transmission on this UCC. */
242 gumr = in_be32(&uf_regs->gumr);
243 if (mode & COMM_DIR_TX) {
244 gumr |= UCC_FAST_GUMR_ENT;
245 uccf->enabled_tx = 1;
246 }
247 if (mode & COMM_DIR_RX) {
248 gumr |= UCC_FAST_GUMR_ENR;
249 uccf->enabled_rx = 1;
250 }
251 out_be32(&uf_regs->gumr, gumr);
252}
253
254void ucc_fast_disable(ucc_fast_private_t *uccf, comm_dir_e mode)
255{
256 ucc_fast_t *uf_regs;
257 u32 gumr;
258
259 uf_regs = uccf->uf_regs;
260
261 /* Disable reception and/or transmission on this UCC. */
262 gumr = in_be32(&uf_regs->gumr);
263 if (mode & COMM_DIR_TX) {
264 gumr &= ~UCC_FAST_GUMR_ENT;
265 uccf->enabled_tx = 0;
266 }
267 if (mode & COMM_DIR_RX) {
268 gumr &= ~UCC_FAST_GUMR_ENR;
269 uccf->enabled_rx = 0;
270 }
271 out_be32(&uf_regs->gumr, gumr);
272}
273
274int ucc_fast_init(ucc_fast_info_t *uf_info, ucc_fast_private_t **uccf_ret)
275{
276 ucc_fast_private_t *uccf;
277 ucc_fast_t *uf_regs;
278
279 if (!uf_info)
280 return -EINVAL;
281
282 if ((uf_info->ucc_num < 0) || (uf_info->ucc_num > UCC_MAX_NUM - 1)) {
283 printf("%s: Illagal UCC number!\n", __FUNCTION__);
284 return -EINVAL;
285 }
286
287 uccf = (ucc_fast_private_t *)malloc(sizeof(ucc_fast_private_t));
288 if (!uccf) {
289 printf("%s: No memory for UCC fast data structure!\n",
290 __FUNCTION__);
291 return -ENOMEM;
292 }
293 memset(uccf, 0, sizeof(ucc_fast_private_t));
294
295 /* Save fast UCC structure */
296 uccf->uf_info = uf_info;
297 uccf->uf_regs = (ucc_fast_t *)ucc_get_reg_baseaddr(uf_info->ucc_num);
298
299 if (uccf->uf_regs == NULL) {
300 printf("%s: No memory map for UCC fast controller!\n",
301 __FUNCTION__);
302 return -ENOMEM;
303 }
304
305 uccf->enabled_tx = 0;
306 uccf->enabled_rx = 0;
307
308 uf_regs = uccf->uf_regs;
309 uccf->p_ucce = (u32 *) &(uf_regs->ucce);
310 uccf->p_uccm = (u32 *) &(uf_regs->uccm);
311
312 /* Init GUEMR register, UCC both Rx and Tx is Fast protocol */
313 out_8(&uf_regs->guemr, UCC_GUEMR_SET_RESERVED3 | UCC_GUEMR_MODE_FAST_RX
314 | UCC_GUEMR_MODE_FAST_TX);
315
316 /* Set GUMR, disable UCC both Rx and Tx, Ethernet protocol */
317 out_be32(&uf_regs->gumr, UCC_FAST_GUMR_ETH);
318
319 /* Set the Giga ethernet VFIFO stuff */
320 if (uf_info->eth_type == GIGA_ETH) {
321 /* Allocate memory for Tx Virtual Fifo */
322 uccf->ucc_fast_tx_virtual_fifo_base_offset =
323 qe_muram_alloc(UCC_GETH_UTFS_GIGA_INIT,
324 UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT);
325
326 /* Allocate memory for Rx Virtual Fifo */
327 uccf->ucc_fast_rx_virtual_fifo_base_offset =
328 qe_muram_alloc(UCC_GETH_URFS_GIGA_INIT +
329 UCC_FAST_RX_VIRTUAL_FIFO_SIZE_PAD,
330 UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT);
331
332 /* utfb, urfb are offsets from MURAM base */
333 out_be32(&uf_regs->utfb,
334 uccf->ucc_fast_tx_virtual_fifo_base_offset);
335 out_be32(&uf_regs->urfb,
336 uccf->ucc_fast_rx_virtual_fifo_base_offset);
337
338 /* Set Virtual Fifo registers */
339 out_be16(&uf_regs->urfs, UCC_GETH_URFS_GIGA_INIT);
340 out_be16(&uf_regs->urfet, UCC_GETH_URFET_GIGA_INIT);
341 out_be16(&uf_regs->urfset, UCC_GETH_URFSET_GIGA_INIT);
342 out_be16(&uf_regs->utfs, UCC_GETH_UTFS_GIGA_INIT);
343 out_be16(&uf_regs->utfet, UCC_GETH_UTFET_GIGA_INIT);
344 out_be16(&uf_regs->utftt, UCC_GETH_UTFTT_GIGA_INIT);
345 }
346
347 /* Set the Fast ethernet VFIFO stuff */
348 if (uf_info->eth_type == FAST_ETH) {
349 /* Allocate memory for Tx Virtual Fifo */
350 uccf->ucc_fast_tx_virtual_fifo_base_offset =
351 qe_muram_alloc(UCC_GETH_UTFS_INIT,
352 UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT);
353
354 /* Allocate memory for Rx Virtual Fifo */
355 uccf->ucc_fast_rx_virtual_fifo_base_offset =
356 qe_muram_alloc(UCC_GETH_URFS_INIT +
357 UCC_FAST_RX_VIRTUAL_FIFO_SIZE_PAD,
358 UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT);
359
360 /* utfb, urfb are offsets from MURAM base */
361 out_be32(&uf_regs->utfb,
362 uccf->ucc_fast_tx_virtual_fifo_base_offset);
363 out_be32(&uf_regs->urfb,
364 uccf->ucc_fast_rx_virtual_fifo_base_offset);
365
366 /* Set Virtual Fifo registers */
367 out_be16(&uf_regs->urfs, UCC_GETH_URFS_INIT);
368 out_be16(&uf_regs->urfet, UCC_GETH_URFET_INIT);
369 out_be16(&uf_regs->urfset, UCC_GETH_URFSET_INIT);
370 out_be16(&uf_regs->utfs, UCC_GETH_UTFS_INIT);
371 out_be16(&uf_regs->utfet, UCC_GETH_UTFET_INIT);
Wolfgang Denk53677ef2008-05-20 16:00:29 +0200372 out_be16(&uf_regs->utftt, UCC_GETH_UTFTT_INIT);
Dave Liu7737d5c2006-11-03 12:11:15 -0600373 }
374
375 /* Rx clock routing */
376 if (uf_info->rx_clock != QE_CLK_NONE) {
377 if (ucc_set_clk_src(uf_info->ucc_num,
378 uf_info->rx_clock, COMM_DIR_RX)) {
379 printf("%s: Illegal value for parameter 'RxClock'.\n",
380 __FUNCTION__);
381 return -EINVAL;
382 }
383 }
384
385 /* Tx clock routing */
386 if (uf_info->tx_clock != QE_CLK_NONE) {
387 if (ucc_set_clk_src(uf_info->ucc_num,
388 uf_info->tx_clock, COMM_DIR_TX)) {
389 printf("%s: Illegal value for parameter 'TxClock'.\n",
390 __FUNCTION__);
391 return -EINVAL;
392 }
393 }
394
395 /* Clear interrupt mask register to disable all of interrupts */
396 out_be32(&uf_regs->uccm, 0x0);
397
398 /* Writing '1' to clear all of envents */
399 out_be32(&uf_regs->ucce, 0xffffffff);
400
401 *uccf_ret = uccf;
402 return 0;
403}
404#endif /* CONFIG_QE */