2 * Copyright (C) 2006 Freescale Semiconductor, Inc. All rights reserved.
4 * Authors: Shlomi Gridish <gridish@freescale.com>
5 * Li Yang <leoli@freescale.com>
8 * QE UCC Fast API Set - UCC Fast specific routines implementations.
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
15 #include <linux/kernel.h>
16 #include <linux/init.h>
17 #include <linux/errno.h>
18 #include <linux/slab.h>
19 #include <linux/stddef.h>
20 #include <linux/interrupt.h>
21 #include <linux/err.h>
22 #include <linux/export.h>
25 #include <asm/immap_qe.h>
29 #include <asm/ucc_fast.h>
31 void ucc_fast_dump_regs(struct ucc_fast_private
* uccf
)
33 printk(KERN_INFO
"UCC%u Fast registers:\n", uccf
->uf_info
->ucc_num
);
34 printk(KERN_INFO
"Base address: 0x%p\n", uccf
->uf_regs
);
36 printk(KERN_INFO
"gumr : addr=0x%p, val=0x%08x\n",
37 &uccf
->uf_regs
->gumr
, in_be32(&uccf
->uf_regs
->gumr
));
38 printk(KERN_INFO
"upsmr : addr=0x%p, val=0x%08x\n",
39 &uccf
->uf_regs
->upsmr
, in_be32(&uccf
->uf_regs
->upsmr
));
40 printk(KERN_INFO
"utodr : addr=0x%p, val=0x%04x\n",
41 &uccf
->uf_regs
->utodr
, in_be16(&uccf
->uf_regs
->utodr
));
42 printk(KERN_INFO
"udsr : addr=0x%p, val=0x%04x\n",
43 &uccf
->uf_regs
->udsr
, in_be16(&uccf
->uf_regs
->udsr
));
44 printk(KERN_INFO
"ucce : addr=0x%p, val=0x%08x\n",
45 &uccf
->uf_regs
->ucce
, in_be32(&uccf
->uf_regs
->ucce
));
46 printk(KERN_INFO
"uccm : addr=0x%p, val=0x%08x\n",
47 &uccf
->uf_regs
->uccm
, in_be32(&uccf
->uf_regs
->uccm
));
48 printk(KERN_INFO
"uccs : addr=0x%p, val=0x%02x\n",
49 &uccf
->uf_regs
->uccs
, in_8(&uccf
->uf_regs
->uccs
));
50 printk(KERN_INFO
"urfb : addr=0x%p, val=0x%08x\n",
51 &uccf
->uf_regs
->urfb
, in_be32(&uccf
->uf_regs
->urfb
));
52 printk(KERN_INFO
"urfs : addr=0x%p, val=0x%04x\n",
53 &uccf
->uf_regs
->urfs
, in_be16(&uccf
->uf_regs
->urfs
));
54 printk(KERN_INFO
"urfet : addr=0x%p, val=0x%04x\n",
55 &uccf
->uf_regs
->urfet
, in_be16(&uccf
->uf_regs
->urfet
));
56 printk(KERN_INFO
"urfset: addr=0x%p, val=0x%04x\n",
57 &uccf
->uf_regs
->urfset
, in_be16(&uccf
->uf_regs
->urfset
));
58 printk(KERN_INFO
"utfb : addr=0x%p, val=0x%08x\n",
59 &uccf
->uf_regs
->utfb
, in_be32(&uccf
->uf_regs
->utfb
));
60 printk(KERN_INFO
"utfs : addr=0x%p, val=0x%04x\n",
61 &uccf
->uf_regs
->utfs
, in_be16(&uccf
->uf_regs
->utfs
));
62 printk(KERN_INFO
"utfet : addr=0x%p, val=0x%04x\n",
63 &uccf
->uf_regs
->utfet
, in_be16(&uccf
->uf_regs
->utfet
));
64 printk(KERN_INFO
"utftt : addr=0x%p, val=0x%04x\n",
65 &uccf
->uf_regs
->utftt
, in_be16(&uccf
->uf_regs
->utftt
));
66 printk(KERN_INFO
"utpt : addr=0x%p, val=0x%04x\n",
67 &uccf
->uf_regs
->utpt
, in_be16(&uccf
->uf_regs
->utpt
));
68 printk(KERN_INFO
"urtry : addr=0x%p, val=0x%08x\n",
69 &uccf
->uf_regs
->urtry
, in_be32(&uccf
->uf_regs
->urtry
));
70 printk(KERN_INFO
"guemr : addr=0x%p, val=0x%02x\n",
71 &uccf
->uf_regs
->guemr
, in_8(&uccf
->uf_regs
->guemr
));
73 EXPORT_SYMBOL(ucc_fast_dump_regs
);
75 u32
ucc_fast_get_qe_cr_subblock(int uccf_num
)
78 case 0: return QE_CR_SUBBLOCK_UCCFAST1
;
79 case 1: return QE_CR_SUBBLOCK_UCCFAST2
;
80 case 2: return QE_CR_SUBBLOCK_UCCFAST3
;
81 case 3: return QE_CR_SUBBLOCK_UCCFAST4
;
82 case 4: return QE_CR_SUBBLOCK_UCCFAST5
;
83 case 5: return QE_CR_SUBBLOCK_UCCFAST6
;
84 case 6: return QE_CR_SUBBLOCK_UCCFAST7
;
85 case 7: return QE_CR_SUBBLOCK_UCCFAST8
;
86 default: return QE_CR_SUBBLOCK_INVALID
;
89 EXPORT_SYMBOL(ucc_fast_get_qe_cr_subblock
);
91 void ucc_fast_transmit_on_demand(struct ucc_fast_private
* uccf
)
93 out_be16(&uccf
->uf_regs
->utodr
, UCC_FAST_TOD
);
95 EXPORT_SYMBOL(ucc_fast_transmit_on_demand
);
97 void ucc_fast_enable(struct ucc_fast_private
* uccf
, enum comm_dir mode
)
99 struct ucc_fast __iomem
*uf_regs
;
102 uf_regs
= uccf
->uf_regs
;
104 /* Enable reception and/or transmission on this UCC. */
105 gumr
= in_be32(&uf_regs
->gumr
);
106 if (mode
& COMM_DIR_TX
) {
107 gumr
|= UCC_FAST_GUMR_ENT
;
108 uccf
->enabled_tx
= 1;
110 if (mode
& COMM_DIR_RX
) {
111 gumr
|= UCC_FAST_GUMR_ENR
;
112 uccf
->enabled_rx
= 1;
114 out_be32(&uf_regs
->gumr
, gumr
);
116 EXPORT_SYMBOL(ucc_fast_enable
);
118 void ucc_fast_disable(struct ucc_fast_private
* uccf
, enum comm_dir mode
)
120 struct ucc_fast __iomem
*uf_regs
;
123 uf_regs
= uccf
->uf_regs
;
125 /* Disable reception and/or transmission on this UCC. */
126 gumr
= in_be32(&uf_regs
->gumr
);
127 if (mode
& COMM_DIR_TX
) {
128 gumr
&= ~UCC_FAST_GUMR_ENT
;
129 uccf
->enabled_tx
= 0;
131 if (mode
& COMM_DIR_RX
) {
132 gumr
&= ~UCC_FAST_GUMR_ENR
;
133 uccf
->enabled_rx
= 0;
135 out_be32(&uf_regs
->gumr
, gumr
);
137 EXPORT_SYMBOL(ucc_fast_disable
);
139 int ucc_fast_init(struct ucc_fast_info
* uf_info
, struct ucc_fast_private
** uccf_ret
)
141 struct ucc_fast_private
*uccf
;
142 struct ucc_fast __iomem
*uf_regs
;
149 /* check if the UCC port number is in range. */
150 if ((uf_info
->ucc_num
< 0) || (uf_info
->ucc_num
> UCC_MAX_NUM
- 1)) {
151 printk(KERN_ERR
"%s: illegal UCC number\n", __func__
);
155 /* Check that 'max_rx_buf_length' is properly aligned (4). */
156 if (uf_info
->max_rx_buf_length
& (UCC_FAST_MRBLR_ALIGNMENT
- 1)) {
157 printk(KERN_ERR
"%s: max_rx_buf_length not aligned\n",
162 /* Validate Virtual Fifo register values */
163 if (uf_info
->urfs
< UCC_FAST_URFS_MIN_VAL
) {
164 printk(KERN_ERR
"%s: urfs is too small\n", __func__
);
168 if (uf_info
->urfs
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
169 printk(KERN_ERR
"%s: urfs is not aligned\n", __func__
);
173 if (uf_info
->urfet
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
174 printk(KERN_ERR
"%s: urfet is not aligned.\n", __func__
);
178 if (uf_info
->urfset
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
179 printk(KERN_ERR
"%s: urfset is not aligned\n", __func__
);
183 if (uf_info
->utfs
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
184 printk(KERN_ERR
"%s: utfs is not aligned\n", __func__
);
188 if (uf_info
->utfet
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
189 printk(KERN_ERR
"%s: utfet is not aligned\n", __func__
);
193 if (uf_info
->utftt
& (UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
- 1)) {
194 printk(KERN_ERR
"%s: utftt is not aligned\n", __func__
);
198 uccf
= kzalloc(sizeof(struct ucc_fast_private
), GFP_KERNEL
);
200 printk(KERN_ERR
"%s: Cannot allocate private data\n",
205 /* Fill fast UCC structure */
206 uccf
->uf_info
= uf_info
;
207 /* Set the PHY base address */
208 uccf
->uf_regs
= ioremap(uf_info
->regs
, sizeof(struct ucc_fast
));
209 if (uccf
->uf_regs
== NULL
) {
210 printk(KERN_ERR
"%s: Cannot map UCC registers\n", __func__
);
215 uccf
->enabled_tx
= 0;
216 uccf
->enabled_rx
= 0;
217 uccf
->stopped_tx
= 0;
218 uccf
->stopped_rx
= 0;
219 uf_regs
= uccf
->uf_regs
;
220 uccf
->p_ucce
= &uf_regs
->ucce
;
221 uccf
->p_uccm
= &uf_regs
->uccm
;
222 #ifdef CONFIG_UGETH_TX_ON_DEMAND
223 uccf
->p_utodr
= &uf_regs
->utodr
;
228 uccf
->rx_discarded
= 0;
229 #endif /* STATISTICS */
231 /* Set UCC to fast type */
232 ret
= ucc_set_type(uf_info
->ucc_num
, UCC_SPEED_TYPE_FAST
);
234 printk(KERN_ERR
"%s: cannot set UCC type\n", __func__
);
239 uccf
->mrblr
= uf_info
->max_rx_buf_length
;
242 /* For more details see the hardware spec. */
243 gumr
= uf_info
->ttx_trx
;
245 gumr
|= UCC_FAST_GUMR_TCI
;
247 gumr
|= UCC_FAST_GUMR_CDP
;
249 gumr
|= UCC_FAST_GUMR_CTSP
;
251 gumr
|= UCC_FAST_GUMR_CDS
;
253 gumr
|= UCC_FAST_GUMR_CTSS
;
255 gumr
|= UCC_FAST_GUMR_TXSY
;
257 gumr
|= UCC_FAST_GUMR_RSYN
;
258 gumr
|= uf_info
->synl
;
260 gumr
|= UCC_FAST_GUMR_RTSM
;
261 gumr
|= uf_info
->renc
;
263 gumr
|= UCC_FAST_GUMR_REVD
;
264 gumr
|= uf_info
->tenc
;
265 gumr
|= uf_info
->tcrc
;
266 gumr
|= uf_info
->mode
;
267 out_be32(&uf_regs
->gumr
, gumr
);
269 /* Allocate memory for Tx Virtual Fifo */
270 uccf
->ucc_fast_tx_virtual_fifo_base_offset
=
271 qe_muram_alloc(uf_info
->utfs
, UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
);
272 if (IS_ERR_VALUE(uccf
->ucc_fast_tx_virtual_fifo_base_offset
)) {
273 printk(KERN_ERR
"%s: cannot allocate MURAM for TX FIFO\n",
275 uccf
->ucc_fast_tx_virtual_fifo_base_offset
= 0;
280 /* Allocate memory for Rx Virtual Fifo */
281 uccf
->ucc_fast_rx_virtual_fifo_base_offset
=
282 qe_muram_alloc(uf_info
->urfs
+
283 UCC_FAST_RECEIVE_VIRTUAL_FIFO_SIZE_FUDGE_FACTOR
,
284 UCC_FAST_VIRT_FIFO_REGS_ALIGNMENT
);
285 if (IS_ERR_VALUE(uccf
->ucc_fast_rx_virtual_fifo_base_offset
)) {
286 printk(KERN_ERR
"%s: cannot allocate MURAM for RX FIFO\n",
288 uccf
->ucc_fast_rx_virtual_fifo_base_offset
= 0;
293 /* Set Virtual Fifo registers */
294 out_be16(&uf_regs
->urfs
, uf_info
->urfs
);
295 out_be16(&uf_regs
->urfet
, uf_info
->urfet
);
296 out_be16(&uf_regs
->urfset
, uf_info
->urfset
);
297 out_be16(&uf_regs
->utfs
, uf_info
->utfs
);
298 out_be16(&uf_regs
->utfet
, uf_info
->utfet
);
299 out_be16(&uf_regs
->utftt
, uf_info
->utftt
);
300 /* utfb, urfb are offsets from MURAM base */
301 out_be32(&uf_regs
->utfb
, uccf
->ucc_fast_tx_virtual_fifo_base_offset
);
302 out_be32(&uf_regs
->urfb
, uccf
->ucc_fast_rx_virtual_fifo_base_offset
);
306 ucc_set_qe_mux_grant(uf_info
->ucc_num
, uf_info
->grant_support
);
307 /* Breakpoint Support */
308 ucc_set_qe_mux_bkpt(uf_info
->ucc_num
, uf_info
->brkpt_support
);
309 /* Set Tsa or NMSI mode. */
310 ucc_set_qe_mux_tsa(uf_info
->ucc_num
, uf_info
->tsa
);
311 /* If NMSI (not Tsa), set Tx and Rx clock. */
313 /* Rx clock routing */
314 if ((uf_info
->rx_clock
!= QE_CLK_NONE
) &&
315 ucc_set_qe_mux_rxtx(uf_info
->ucc_num
, uf_info
->rx_clock
,
317 printk(KERN_ERR
"%s: illegal value for RX clock\n",
322 /* Tx clock routing */
323 if ((uf_info
->tx_clock
!= QE_CLK_NONE
) &&
324 ucc_set_qe_mux_rxtx(uf_info
->ucc_num
, uf_info
->tx_clock
,
326 printk(KERN_ERR
"%s: illegal value for TX clock\n",
333 /* Set interrupt mask register at UCC level. */
334 out_be32(&uf_regs
->uccm
, uf_info
->uccm_mask
);
336 /* First, clear anything pending at UCC level,
337 * otherwise, old garbage may come through
338 * as soon as the dam is opened. */
340 /* Writing '1' clears */
341 out_be32(&uf_regs
->ucce
, 0xffffffff);
346 EXPORT_SYMBOL(ucc_fast_init
);
348 void ucc_fast_free(struct ucc_fast_private
* uccf
)
353 if (uccf
->ucc_fast_tx_virtual_fifo_base_offset
)
354 qe_muram_free(uccf
->ucc_fast_tx_virtual_fifo_base_offset
);
356 if (uccf
->ucc_fast_rx_virtual_fifo_base_offset
)
357 qe_muram_free(uccf
->ucc_fast_rx_virtual_fifo_base_offset
);
360 iounmap(uccf
->uf_regs
);
364 EXPORT_SYMBOL(ucc_fast_free
);