1 /* Freescale QUICC Engine HDLC Device Driver
3 * Copyright 2016 Freescale Semiconductor Inc.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2 of the License, or (at your
8 * option) any later version.
11 #include <linux/delay.h>
12 #include <linux/dma-mapping.h>
13 #include <linux/hdlc.h>
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
17 #include <linux/irq.h>
18 #include <linux/kernel.h>
19 #include <linux/module.h>
20 #include <linux/netdevice.h>
21 #include <linux/of_address.h>
22 #include <linux/of_irq.h>
23 #include <linux/of_platform.h>
24 #include <linux/platform_device.h>
25 #include <linux/sched.h>
26 #include <linux/skbuff.h>
27 #include <linux/slab.h>
28 #include <linux/spinlock.h>
29 #include <linux/stddef.h>
30 #include <soc/fsl/qe/qe_tdm.h>
31 #include <uapi/linux/if_arp.h>
33 #include "fsl_ucc_hdlc.h"
35 #define DRV_DESC "Freescale QE UCC HDLC Driver"
36 #define DRV_NAME "ucc_hdlc"
38 #define TDM_PPPOHT_SLIC_MAXIN
39 #define BROKEN_FRAME_INFO
41 static struct ucc_tdm_info utdm_primary_info
= {
56 .mode
= UCC_FAST_PROTOCOL_MODE_HDLC
,
57 .ttx_trx
= UCC_FAST_GUMR_TRANSPARENT_TTX_TRX_NORMAL
,
58 .tenc
= UCC_FAST_TX_ENCODING_NRZ
,
59 .renc
= UCC_FAST_RX_ENCODING_NRZ
,
60 .tcrc
= UCC_FAST_16_BIT_CRC
,
61 .synl
= UCC_FAST_SYNC_LEN_NOT_USED
,
65 #ifdef TDM_PPPOHT_SLIC_MAXIN
80 static struct ucc_tdm_info utdm_info
[MAX_HDLC_NUM
];
82 static int uhdlc_init(struct ucc_hdlc_private
*priv
)
84 struct ucc_tdm_info
*ut_info
;
85 struct ucc_fast_info
*uf_info
;
90 dma_addr_t bd_dma_addr
;
95 ut_info
= priv
->ut_info
;
96 uf_info
= &ut_info
->uf_info
;
102 uf_info
->uccm_mask
= ((UCC_HDLC_UCCE_RXB
| UCC_HDLC_UCCE_RXF
|
103 UCC_HDLC_UCCE_TXB
) << 16);
105 ret
= ucc_fast_init(uf_info
, &priv
->uccf
);
107 dev_err(priv
->dev
, "Failed to init uccf.");
111 priv
->uf_regs
= priv
->uccf
->uf_regs
;
112 ucc_fast_disable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
115 if (priv
->loopback
) {
116 dev_info(priv
->dev
, "Loopback Mode\n");
117 gumr
= ioread32be(&priv
->uf_regs
->gumr
);
118 gumr
|= (UCC_FAST_GUMR_LOOPBACK
| UCC_FAST_GUMR_CDS
|
120 gumr
&= ~(UCC_FAST_GUMR_CTSP
| UCC_FAST_GUMR_RSYN
);
121 iowrite32be(gumr
, &priv
->uf_regs
->gumr
);
126 ucc_tdm_init(priv
->utdm
, priv
->ut_info
);
128 /* Write to QE CECR, UCCx channel to Stop Transmission */
129 cecr_subblock
= ucc_fast_get_qe_cr_subblock(uf_info
->ucc_num
);
130 ret
= qe_issue_cmd(QE_STOP_TX
, cecr_subblock
,
131 QE_CR_PROTOCOL_UNSPECIFIED
, 0);
133 /* Set UPSMR normal mode (need fixed)*/
134 iowrite32be(0, &priv
->uf_regs
->upsmr
);
136 priv
->rx_ring_size
= RX_BD_RING_LEN
;
137 priv
->tx_ring_size
= TX_BD_RING_LEN
;
139 priv
->rx_bd_base
= dma_alloc_coherent(priv
->dev
,
140 RX_BD_RING_LEN
* sizeof(struct qe_bd
*),
141 &priv
->dma_rx_bd
, GFP_KERNEL
);
143 if (!priv
->rx_bd_base
) {
144 dev_err(priv
->dev
, "Cannot allocate MURAM memory for RxBDs\n");
150 priv
->tx_bd_base
= dma_alloc_coherent(priv
->dev
,
151 TX_BD_RING_LEN
* sizeof(struct qe_bd
*),
152 &priv
->dma_tx_bd
, GFP_KERNEL
);
154 if (!priv
->tx_bd_base
) {
155 dev_err(priv
->dev
, "Cannot allocate MURAM memory for TxBDs\n");
160 /* Alloc parameter ram for ucc hdlc */
161 priv
->ucc_pram_offset
= qe_muram_alloc(sizeof(priv
->ucc_pram
),
162 ALIGNMENT_OF_UCC_HDLC_PRAM
);
164 if (priv
->ucc_pram_offset
< 0) {
165 dev_err(priv
->dev
, "Can not allocate MURAM for hdlc parameter.\n");
170 priv
->rx_skbuff
= kzalloc(priv
->rx_ring_size
* sizeof(*priv
->rx_skbuff
),
172 if (!priv
->rx_skbuff
)
175 priv
->tx_skbuff
= kzalloc(priv
->tx_ring_size
* sizeof(*priv
->tx_skbuff
),
177 if (!priv
->tx_skbuff
)
181 priv
->skb_dirtytx
= 0;
182 priv
->curtx_bd
= priv
->tx_bd_base
;
183 priv
->dirty_tx
= priv
->tx_bd_base
;
184 priv
->currx_bd
= priv
->rx_bd_base
;
185 priv
->currx_bdnum
= 0;
187 /* init parameter base */
188 cecr_subblock
= ucc_fast_get_qe_cr_subblock(uf_info
->ucc_num
);
189 ret
= qe_issue_cmd(QE_ASSIGN_PAGE_TO_DEVICE
, cecr_subblock
,
190 QE_CR_PROTOCOL_UNSPECIFIED
, priv
->ucc_pram_offset
);
192 priv
->ucc_pram
= (struct ucc_hdlc_param __iomem
*)
193 qe_muram_addr(priv
->ucc_pram_offset
);
195 /* Zero out parameter ram */
196 memset_io(priv
->ucc_pram
, 0, sizeof(struct ucc_hdlc_param
));
198 /* Alloc riptr, tiptr */
199 riptr
= qe_muram_alloc(32, 32);
201 dev_err(priv
->dev
, "Cannot allocate MURAM mem for Receive internal temp data pointer\n");
206 tiptr
= qe_muram_alloc(32, 32);
208 dev_err(priv
->dev
, "Cannot allocate MURAM mem for Transmit internal temp data pointer\n");
213 /* Set RIPTR, TIPTR */
214 iowrite16be(riptr
, &priv
->ucc_pram
->riptr
);
215 iowrite16be(tiptr
, &priv
->ucc_pram
->tiptr
);
218 iowrite16be(MAX_RX_BUF_LENGTH
, &priv
->ucc_pram
->mrblr
);
220 /* Set RBASE, TBASE */
221 iowrite32be(priv
->dma_rx_bd
, &priv
->ucc_pram
->rbase
);
222 iowrite32be(priv
->dma_tx_bd
, &priv
->ucc_pram
->tbase
);
224 /* Set RSTATE, TSTATE */
225 iowrite32be(BMR_GBL
| BMR_BIG_ENDIAN
, &priv
->ucc_pram
->rstate
);
226 iowrite32be(BMR_GBL
| BMR_BIG_ENDIAN
, &priv
->ucc_pram
->tstate
);
228 /* Set C_MASK, C_PRES for 16bit CRC */
229 iowrite32be(CRC_16BIT_MASK
, &priv
->ucc_pram
->c_mask
);
230 iowrite32be(CRC_16BIT_PRES
, &priv
->ucc_pram
->c_pres
);
232 iowrite16be(MAX_FRAME_LENGTH
, &priv
->ucc_pram
->mflr
);
233 iowrite16be(DEFAULT_RFTHR
, &priv
->ucc_pram
->rfthr
);
234 iowrite16be(DEFAULT_RFTHR
, &priv
->ucc_pram
->rfcnt
);
235 iowrite16be(DEFAULT_ADDR_MASK
, &priv
->ucc_pram
->hmask
);
236 iowrite16be(DEFAULT_HDLC_ADDR
, &priv
->ucc_pram
->haddr1
);
237 iowrite16be(DEFAULT_HDLC_ADDR
, &priv
->ucc_pram
->haddr2
);
238 iowrite16be(DEFAULT_HDLC_ADDR
, &priv
->ucc_pram
->haddr3
);
239 iowrite16be(DEFAULT_HDLC_ADDR
, &priv
->ucc_pram
->haddr4
);
242 bd_buffer
= dma_alloc_coherent(priv
->dev
,
243 (RX_BD_RING_LEN
+ TX_BD_RING_LEN
) *
245 &bd_dma_addr
, GFP_KERNEL
);
248 dev_err(priv
->dev
, "Could not allocate buffer descriptors\n");
253 memset(bd_buffer
, 0, (RX_BD_RING_LEN
+ TX_BD_RING_LEN
)
254 * MAX_RX_BUF_LENGTH
);
256 priv
->rx_buffer
= bd_buffer
;
257 priv
->tx_buffer
= bd_buffer
+ RX_BD_RING_LEN
* MAX_RX_BUF_LENGTH
;
259 priv
->dma_rx_addr
= bd_dma_addr
;
260 priv
->dma_tx_addr
= bd_dma_addr
+ RX_BD_RING_LEN
* MAX_RX_BUF_LENGTH
;
262 for (i
= 0; i
< RX_BD_RING_LEN
; i
++) {
263 if (i
< (RX_BD_RING_LEN
- 1))
264 bd_status
= R_E_S
| R_I_S
;
266 bd_status
= R_E_S
| R_I_S
| R_W_S
;
268 iowrite16be(bd_status
, &priv
->rx_bd_base
[i
].status
);
269 iowrite32be(priv
->dma_rx_addr
+ i
* MAX_RX_BUF_LENGTH
,
270 &priv
->rx_bd_base
[i
].buf
);
273 for (i
= 0; i
< TX_BD_RING_LEN
; i
++) {
274 if (i
< (TX_BD_RING_LEN
- 1))
275 bd_status
= T_I_S
| T_TC_S
;
277 bd_status
= T_I_S
| T_TC_S
| T_W_S
;
279 iowrite16be(bd_status
, &priv
->tx_bd_base
[i
].status
);
280 iowrite32be(priv
->dma_tx_addr
+ i
* MAX_RX_BUF_LENGTH
,
281 &priv
->tx_bd_base
[i
].buf
);
287 qe_muram_free(tiptr
);
289 qe_muram_free(riptr
);
291 kfree(priv
->tx_skbuff
);
293 kfree(priv
->rx_skbuff
);
295 qe_muram_free(priv
->ucc_pram_offset
);
297 dma_free_coherent(priv
->dev
,
298 TX_BD_RING_LEN
* sizeof(struct qe_bd
),
299 priv
->tx_bd_base
, priv
->dma_tx_bd
);
301 dma_free_coherent(priv
->dev
,
302 RX_BD_RING_LEN
* sizeof(struct qe_bd
),
303 priv
->rx_bd_base
, priv
->dma_rx_bd
);
305 ucc_fast_free(priv
->uccf
);
310 static netdev_tx_t
ucc_hdlc_tx(struct sk_buff
*skb
, struct net_device
*dev
)
312 hdlc_device
*hdlc
= dev_to_hdlc(dev
);
313 struct ucc_hdlc_private
*priv
= (struct ucc_hdlc_private
*)hdlc
->priv
;
314 struct qe_bd __iomem
*bd
;
323 if (skb_headroom(skb
) < HDLC_HEAD_LEN
) {
324 dev
->stats
.tx_dropped
++;
326 netdev_err(dev
, "No enough space for hdlc head\n");
330 skb_push(skb
, HDLC_HEAD_LEN
);
332 proto_head
= (u16
*)skb
->data
;
333 *proto_head
= htons(DEFAULT_HDLC_HEAD
);
335 dev
->stats
.tx_bytes
+= skb
->len
;
339 proto_head
= (u16
*)skb
->data
;
340 if (*proto_head
!= htons(DEFAULT_PPP_HEAD
)) {
341 dev
->stats
.tx_dropped
++;
343 netdev_err(dev
, "Wrong ppp header\n");
347 dev
->stats
.tx_bytes
+= skb
->len
;
351 dev
->stats
.tx_dropped
++;
356 pr_info("Tx data skb->len:%d ", skb
->len
);
357 send_buf
= (u8
*)skb
->data
;
358 pr_info("\nTransmitted data:\n");
359 for (i
= 0; i
< 16; i
++) {
363 pr_info("%02x\n", send_buf
[i
]);
365 spin_lock_irqsave(&priv
->lock
, flags
);
367 /* Start from the next BD that should be filled */
369 bd_status
= ioread16be(&bd
->status
);
370 /* Save the skb pointer so we can free it later */
371 priv
->tx_skbuff
[priv
->skb_curtx
] = skb
;
373 /* Update the current skb pointer (wrapping if this was the last) */
375 (priv
->skb_curtx
+ 1) & TX_RING_MOD_MASK(TX_BD_RING_LEN
);
377 /* copy skb data to tx buffer for sdma processing */
378 memcpy(priv
->tx_buffer
+ (be32_to_cpu(bd
->buf
) - priv
->dma_tx_addr
),
379 skb
->data
, skb
->len
);
381 /* set bd status and length */
382 bd_status
= (bd_status
& T_W_S
) | T_R_S
| T_I_S
| T_L_S
| T_TC_S
;
384 iowrite16be(bd_status
, &bd
->status
);
385 iowrite16be(skb
->len
, &bd
->length
);
387 /* Move to next BD in the ring */
388 if (!(bd_status
& T_W_S
))
391 bd
= priv
->tx_bd_base
;
393 if (bd
== priv
->dirty_tx
) {
394 if (!netif_queue_stopped(dev
))
395 netif_stop_queue(dev
);
400 spin_unlock_irqrestore(&priv
->lock
, flags
);
405 static int hdlc_tx_done(struct ucc_hdlc_private
*priv
)
407 /* Start from the next BD that should be filled */
408 struct net_device
*dev
= priv
->ndev
;
409 struct qe_bd
*bd
; /* BD pointer */
413 bd_status
= ioread16be(&bd
->status
);
415 /* Normal processing. */
416 while ((bd_status
& T_R_S
) == 0) {
419 /* BD contains already transmitted buffer. */
420 /* Handle the transmitted buffer and release */
421 /* the BD to be used with the current frame */
423 skb
= priv
->tx_skbuff
[priv
->skb_dirtytx
];
426 pr_info("TxBD: %x\n", bd_status
);
427 dev
->stats
.tx_packets
++;
428 memset(priv
->tx_buffer
+
429 (be32_to_cpu(bd
->buf
) - priv
->dma_tx_addr
),
431 dev_kfree_skb_irq(skb
);
433 priv
->tx_skbuff
[priv
->skb_dirtytx
] = NULL
;
436 1) & TX_RING_MOD_MASK(TX_BD_RING_LEN
);
438 /* We freed a buffer, so now we can restart transmission */
439 if (netif_queue_stopped(dev
))
440 netif_wake_queue(dev
);
442 /* Advance the confirmation BD pointer */
443 if (!(bd_status
& T_W_S
))
446 bd
= priv
->tx_bd_base
;
447 bd_status
= ioread16be(&bd
->status
);
454 static int hdlc_rx_done(struct ucc_hdlc_private
*priv
, int rx_work_limit
)
456 struct net_device
*dev
= priv
->ndev
;
458 hdlc_device
*hdlc
= dev_to_hdlc(dev
);
461 u16 length
, howmany
= 0;
467 bd_status
= ioread16be(&bd
->status
);
469 /* while there are received buffers and BD is full (~R_E) */
470 while (!((bd_status
& (R_E_S
)) || (--rx_work_limit
< 0))) {
471 if (bd_status
& R_OV_S
)
472 dev
->stats
.rx_over_errors
++;
473 if (bd_status
& R_CR_S
) {
474 #ifdef BROKEN_FRAME_INFO
475 pr_info("Broken Frame with RxBD: %x\n", bd_status
);
477 dev
->stats
.rx_crc_errors
++;
478 dev
->stats
.rx_dropped
++;
481 bdbuffer
= priv
->rx_buffer
+
482 (priv
->currx_bdnum
* MAX_RX_BUF_LENGTH
);
483 length
= ioread16be(&bd
->length
);
485 pr_info("Received data length:%d", length
);
486 pr_info("while entry times:%d", entry
++);
488 pr_info("\nReceived data:\n");
489 for (i
= 0; (i
< 16); i
++) {
493 pr_info("%02x\n", bdbuffer
[i
]);
498 bdbuffer
+= HDLC_HEAD_LEN
;
499 length
-= (HDLC_HEAD_LEN
+ HDLC_CRC_SIZE
);
501 skb
= dev_alloc_skb(length
);
503 dev
->stats
.rx_dropped
++;
507 skb_put(skb
, length
);
510 memcpy(skb
->data
, bdbuffer
, length
);
514 length
-= HDLC_CRC_SIZE
;
516 skb
= dev_alloc_skb(length
);
518 dev
->stats
.rx_dropped
++;
522 skb_put(skb
, length
);
525 memcpy(skb
->data
, bdbuffer
, length
);
529 dev
->stats
.rx_packets
++;
530 dev
->stats
.rx_bytes
+= skb
->len
;
533 skb
->protocol
= hdlc_type_trans(skb
, dev
);
534 pr_info("skb->protocol:%x\n", skb
->protocol
);
535 netif_receive_skb(skb
);
538 iowrite16be(bd_status
| R_E_S
| R_I_S
, &bd
->status
);
540 /* update to point at the next bd */
541 if (bd_status
& R_W_S
) {
542 priv
->currx_bdnum
= 0;
543 bd
= priv
->rx_bd_base
;
545 if (priv
->currx_bdnum
< (RX_BD_RING_LEN
- 1))
546 priv
->currx_bdnum
+= 1;
548 priv
->currx_bdnum
= RX_BD_RING_LEN
- 1;
553 bd_status
= ioread16be(&bd
->status
);
560 static int ucc_hdlc_poll(struct napi_struct
*napi
, int budget
)
562 struct ucc_hdlc_private
*priv
= container_of(napi
,
563 struct ucc_hdlc_private
,
567 /* Tx event processing */
568 spin_lock(&priv
->lock
);
570 spin_unlock(&priv
->lock
);
573 howmany
+= hdlc_rx_done(priv
, budget
- howmany
);
575 if (howmany
< budget
) {
577 qe_setbits32(priv
->uccf
->p_uccm
,
578 (UCCE_HDLC_RX_EVENTS
| UCCE_HDLC_TX_EVENTS
) << 16);
584 static irqreturn_t
ucc_hdlc_irq_handler(int irq
, void *dev_id
)
586 struct ucc_hdlc_private
*priv
= (struct ucc_hdlc_private
*)dev_id
;
587 struct net_device
*dev
= priv
->ndev
;
588 struct ucc_fast_private
*uccf
;
589 struct ucc_tdm_info
*ut_info
;
593 ut_info
= priv
->ut_info
;
596 ucce
= ioread32be(uccf
->p_ucce
);
597 uccm
= ioread32be(uccf
->p_uccm
);
599 iowrite32be(ucce
, uccf
->p_ucce
);
600 pr_info("irq ucce:%x\n", ucce
);
604 if ((ucce
>> 16) & (UCCE_HDLC_RX_EVENTS
| UCCE_HDLC_TX_EVENTS
)) {
605 if (napi_schedule_prep(&priv
->napi
)) {
606 uccm
&= ~((UCCE_HDLC_RX_EVENTS
| UCCE_HDLC_TX_EVENTS
)
608 iowrite32be(uccm
, uccf
->p_uccm
);
609 __napi_schedule(&priv
->napi
);
613 /* Errors and other events */
614 if (ucce
>> 16 & UCC_HDLC_UCCE_BSY
)
615 dev
->stats
.rx_errors
++;
616 if (ucce
>> 16 & UCC_HDLC_UCCE_TXE
)
617 dev
->stats
.tx_errors
++;
622 static int uhdlc_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
624 const size_t size
= sizeof(te1_settings
);
626 struct ucc_hdlc_private
*priv
= netdev_priv(dev
);
628 if (cmd
!= SIOCWANDEV
)
629 return hdlc_ioctl(dev
, ifr
, cmd
);
631 switch (ifr
->ifr_settings
.type
) {
633 ifr
->ifr_settings
.type
= IF_IFACE_E1
;
634 if (ifr
->ifr_settings
.size
< size
) {
635 ifr
->ifr_settings
.size
= size
; /* data size wanted */
638 memset(&line
, 0, sizeof(line
));
639 line
.clock_type
= priv
->clocking
;
641 if (copy_to_user(ifr
->ifr_settings
.ifs_ifsu
.sync
, &line
, size
))
646 return hdlc_ioctl(dev
, ifr
, cmd
);
650 static int uhdlc_open(struct net_device
*dev
)
653 hdlc_device
*hdlc
= dev_to_hdlc(dev
);
654 struct ucc_hdlc_private
*priv
= hdlc
->priv
;
655 struct ucc_tdm
*utdm
= priv
->utdm
;
657 if (priv
->hdlc_busy
!= 1) {
658 if (request_irq(priv
->ut_info
->uf_info
.irq
,
659 ucc_hdlc_irq_handler
, 0, "hdlc", priv
))
662 cecr_subblock
= ucc_fast_get_qe_cr_subblock(
663 priv
->ut_info
->uf_info
.ucc_num
);
665 qe_issue_cmd(QE_INIT_TX_RX
, cecr_subblock
,
666 QE_CR_PROTOCOL_UNSPECIFIED
, 0);
668 ucc_fast_enable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
670 /* Enable the TDM port */
672 utdm
->si_regs
->siglmr1_h
|= (0x1 << utdm
->tdm_port
);
675 netif_device_attach(priv
->ndev
);
676 napi_enable(&priv
->napi
);
677 netif_start_queue(dev
);
684 static void uhdlc_memclean(struct ucc_hdlc_private
*priv
)
686 qe_muram_free(priv
->ucc_pram
->riptr
);
687 qe_muram_free(priv
->ucc_pram
->tiptr
);
689 if (priv
->rx_bd_base
) {
690 dma_free_coherent(priv
->dev
,
691 RX_BD_RING_LEN
* sizeof(struct qe_bd
),
692 priv
->rx_bd_base
, priv
->dma_rx_bd
);
694 priv
->rx_bd_base
= NULL
;
698 if (priv
->tx_bd_base
) {
699 dma_free_coherent(priv
->dev
,
700 TX_BD_RING_LEN
* sizeof(struct qe_bd
),
701 priv
->tx_bd_base
, priv
->dma_tx_bd
);
703 priv
->tx_bd_base
= NULL
;
707 if (priv
->ucc_pram
) {
708 qe_muram_free(priv
->ucc_pram_offset
);
709 priv
->ucc_pram
= NULL
;
710 priv
->ucc_pram_offset
= 0;
713 kfree(priv
->rx_skbuff
);
714 priv
->rx_skbuff
= NULL
;
716 kfree(priv
->tx_skbuff
);
717 priv
->tx_skbuff
= NULL
;
720 iounmap(priv
->uf_regs
);
721 priv
->uf_regs
= NULL
;
725 ucc_fast_free(priv
->uccf
);
729 if (priv
->rx_buffer
) {
730 dma_free_coherent(priv
->dev
,
731 RX_BD_RING_LEN
* MAX_RX_BUF_LENGTH
,
732 priv
->rx_buffer
, priv
->dma_rx_addr
);
733 priv
->rx_buffer
= NULL
;
734 priv
->dma_rx_addr
= 0;
737 if (priv
->tx_buffer
) {
738 dma_free_coherent(priv
->dev
,
739 TX_BD_RING_LEN
* MAX_RX_BUF_LENGTH
,
740 priv
->tx_buffer
, priv
->dma_tx_addr
);
741 priv
->tx_buffer
= NULL
;
742 priv
->dma_tx_addr
= 0;
746 static int uhdlc_close(struct net_device
*dev
)
748 struct ucc_hdlc_private
*priv
= dev_to_hdlc(dev
)->priv
;
749 struct ucc_tdm
*utdm
= priv
->utdm
;
752 napi_disable(&priv
->napi
);
753 cecr_subblock
= ucc_fast_get_qe_cr_subblock(
754 priv
->ut_info
->uf_info
.ucc_num
);
756 qe_issue_cmd(QE_GRACEFUL_STOP_TX
, cecr_subblock
,
757 (u8
)QE_CR_PROTOCOL_UNSPECIFIED
, 0);
758 qe_issue_cmd(QE_CLOSE_RX_BD
, cecr_subblock
,
759 (u8
)QE_CR_PROTOCOL_UNSPECIFIED
, 0);
762 utdm
->si_regs
->siglmr1_h
&= ~(0x1 << utdm
->tdm_port
);
764 ucc_fast_disable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
766 free_irq(priv
->ut_info
->uf_info
.irq
, priv
);
767 netif_stop_queue(dev
);
773 static int ucc_hdlc_attach(struct net_device
*dev
, unsigned short encoding
,
774 unsigned short parity
)
776 struct ucc_hdlc_private
*priv
= dev_to_hdlc(dev
)->priv
;
778 if (encoding
!= ENCODING_NRZ
&&
779 encoding
!= ENCODING_NRZI
)
782 if (parity
!= PARITY_NONE
&&
783 parity
!= PARITY_CRC32_PR1_CCITT
&&
784 parity
!= PARITY_CRC16_PR1_CCITT
)
787 priv
->encoding
= encoding
;
788 priv
->parity
= parity
;
794 static void store_clk_config(struct ucc_hdlc_private
*priv
)
796 struct qe_mux
*qe_mux_reg
= &qe_immr
->qmx
;
799 priv
->cmxsi1cr_h
= ioread32be(&qe_mux_reg
->cmxsi1cr_h
);
800 priv
->cmxsi1cr_l
= ioread32be(&qe_mux_reg
->cmxsi1cr_l
);
803 priv
->cmxsi1syr
= ioread32be(&qe_mux_reg
->cmxsi1syr
);
806 memcpy_fromio(priv
->cmxucr
, qe_mux_reg
->cmxucr
, 4 * sizeof(u32
));
809 static void resume_clk_config(struct ucc_hdlc_private
*priv
)
811 struct qe_mux
*qe_mux_reg
= &qe_immr
->qmx
;
813 memcpy_toio(qe_mux_reg
->cmxucr
, priv
->cmxucr
, 4 * sizeof(u32
));
815 iowrite32be(priv
->cmxsi1cr_h
, &qe_mux_reg
->cmxsi1cr_h
);
816 iowrite32be(priv
->cmxsi1cr_l
, &qe_mux_reg
->cmxsi1cr_l
);
818 iowrite32be(priv
->cmxsi1syr
, &qe_mux_reg
->cmxsi1syr
);
821 static int uhdlc_suspend(struct device
*dev
)
823 struct ucc_hdlc_private
*priv
= dev_get_drvdata(dev
);
824 struct ucc_tdm_info
*ut_info
;
825 struct ucc_fast __iomem
*uf_regs
;
830 if (!netif_running(priv
->ndev
))
833 netif_device_detach(priv
->ndev
);
834 napi_disable(&priv
->napi
);
836 ut_info
= priv
->ut_info
;
837 uf_regs
= priv
->uf_regs
;
839 /* backup gumr guemr*/
840 priv
->gumr
= ioread32be(&uf_regs
->gumr
);
841 priv
->guemr
= ioread8(&uf_regs
->guemr
);
843 priv
->ucc_pram_bak
= kmalloc(sizeof(*priv
->ucc_pram_bak
),
845 if (!priv
->ucc_pram_bak
)
848 /* backup HDLC parameter */
849 memcpy_fromio(priv
->ucc_pram_bak
, priv
->ucc_pram
,
850 sizeof(struct ucc_hdlc_param
));
852 /* store the clk configuration */
853 store_clk_config(priv
);
856 ucc_fast_disable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
858 dev_dbg(dev
, "ucc hdlc suspend\n");
862 static int uhdlc_resume(struct device
*dev
)
864 struct ucc_hdlc_private
*priv
= dev_get_drvdata(dev
);
865 struct ucc_tdm
*utdm
;
866 struct ucc_tdm_info
*ut_info
;
867 struct ucc_fast __iomem
*uf_regs
;
868 struct ucc_fast_private
*uccf
;
869 struct ucc_fast_info
*uf_info
;
877 if (!netif_running(priv
->ndev
))
881 ut_info
= priv
->ut_info
;
882 uf_info
= &ut_info
->uf_info
;
883 uf_regs
= priv
->uf_regs
;
886 /* restore gumr guemr */
887 iowrite8(priv
->guemr
, &uf_regs
->guemr
);
888 iowrite32be(priv
->gumr
, &uf_regs
->gumr
);
890 /* Set Virtual Fifo registers */
891 iowrite16be(uf_info
->urfs
, &uf_regs
->urfs
);
892 iowrite16be(uf_info
->urfet
, &uf_regs
->urfet
);
893 iowrite16be(uf_info
->urfset
, &uf_regs
->urfset
);
894 iowrite16be(uf_info
->utfs
, &uf_regs
->utfs
);
895 iowrite16be(uf_info
->utfet
, &uf_regs
->utfet
);
896 iowrite16be(uf_info
->utftt
, &uf_regs
->utftt
);
897 /* utfb, urfb are offsets from MURAM base */
898 iowrite32be(uccf
->ucc_fast_tx_virtual_fifo_base_offset
, &uf_regs
->utfb
);
899 iowrite32be(uccf
->ucc_fast_rx_virtual_fifo_base_offset
, &uf_regs
->urfb
);
901 /* Rx Tx and sync clock routing */
902 resume_clk_config(priv
);
904 iowrite32be(uf_info
->uccm_mask
, &uf_regs
->uccm
);
905 iowrite32be(0xffffffff, &uf_regs
->ucce
);
907 ucc_fast_disable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
911 ucc_tdm_init(priv
->utdm
, priv
->ut_info
);
913 /* Write to QE CECR, UCCx channel to Stop Transmission */
914 cecr_subblock
= ucc_fast_get_qe_cr_subblock(uf_info
->ucc_num
);
915 ret
= qe_issue_cmd(QE_STOP_TX
, cecr_subblock
,
916 (u8
)QE_CR_PROTOCOL_UNSPECIFIED
, 0);
918 /* Set UPSMR normal mode */
919 iowrite32be(0, &uf_regs
->upsmr
);
921 /* init parameter base */
922 cecr_subblock
= ucc_fast_get_qe_cr_subblock(uf_info
->ucc_num
);
923 ret
= qe_issue_cmd(QE_ASSIGN_PAGE_TO_DEVICE
, cecr_subblock
,
924 QE_CR_PROTOCOL_UNSPECIFIED
, priv
->ucc_pram_offset
);
926 priv
->ucc_pram
= (struct ucc_hdlc_param __iomem
*)
927 qe_muram_addr(priv
->ucc_pram_offset
);
929 /* restore ucc parameter */
930 memcpy_toio(priv
->ucc_pram
, priv
->ucc_pram_bak
,
931 sizeof(struct ucc_hdlc_param
));
932 kfree(priv
->ucc_pram_bak
);
934 /* rebuild BD entry */
935 for (i
= 0; i
< RX_BD_RING_LEN
; i
++) {
936 if (i
< (RX_BD_RING_LEN
- 1))
937 bd_status
= R_E_S
| R_I_S
;
939 bd_status
= R_E_S
| R_I_S
| R_W_S
;
941 iowrite16be(bd_status
, &priv
->rx_bd_base
[i
].status
);
942 iowrite32be(priv
->dma_rx_addr
+ i
* MAX_RX_BUF_LENGTH
,
943 &priv
->rx_bd_base
[i
].buf
);
946 for (i
= 0; i
< TX_BD_RING_LEN
; i
++) {
947 if (i
< (TX_BD_RING_LEN
- 1))
948 bd_status
= T_I_S
| T_TC_S
;
950 bd_status
= T_I_S
| T_TC_S
| T_W_S
;
952 iowrite16be(bd_status
, &priv
->tx_bd_base
[i
].status
);
953 iowrite32be(priv
->dma_tx_addr
+ i
* MAX_RX_BUF_LENGTH
,
954 &priv
->tx_bd_base
[i
].buf
);
957 /* if hdlc is busy enable TX and RX */
958 if (priv
->hdlc_busy
== 1) {
959 cecr_subblock
= ucc_fast_get_qe_cr_subblock(
960 priv
->ut_info
->uf_info
.ucc_num
);
962 qe_issue_cmd(QE_INIT_TX_RX
, cecr_subblock
,
963 (u8
)QE_CR_PROTOCOL_UNSPECIFIED
, 0);
965 ucc_fast_enable(priv
->uccf
, COMM_DIR_RX
| COMM_DIR_TX
);
967 /* Enable the TDM port */
969 utdm
->si_regs
->siglmr1_h
|= (0x1 << utdm
->tdm_port
);
972 napi_enable(&priv
->napi
);
973 netif_device_attach(priv
->ndev
);
978 static const struct dev_pm_ops uhdlc_pm_ops
= {
979 .suspend
= uhdlc_suspend
,
980 .resume
= uhdlc_resume
,
981 .freeze
= uhdlc_suspend
,
982 .thaw
= uhdlc_resume
,
985 #define HDLC_PM_OPS (&uhdlc_pm_ops)
989 #define HDLC_PM_OPS NULL
992 static const struct net_device_ops uhdlc_ops
= {
993 .ndo_open
= uhdlc_open
,
994 .ndo_stop
= uhdlc_close
,
995 .ndo_change_mtu
= hdlc_change_mtu
,
996 .ndo_start_xmit
= hdlc_start_xmit
,
997 .ndo_do_ioctl
= uhdlc_ioctl
,
1000 static int ucc_hdlc_probe(struct platform_device
*pdev
)
1002 struct device_node
*np
= pdev
->dev
.of_node
;
1003 struct ucc_hdlc_private
*uhdlc_priv
= NULL
;
1004 struct ucc_tdm_info
*ut_info
;
1005 struct ucc_tdm
*utdm
;
1006 struct resource res
;
1007 struct net_device
*dev
;
1014 ret
= of_property_read_u32_index(np
, "cell-index", 0, &val
);
1016 dev_err(&pdev
->dev
, "Invalid ucc property\n");
1021 if ((ucc_num
> 3) || (ucc_num
< 0)) {
1022 dev_err(&pdev
->dev
, ": Invalid UCC num\n");
1026 memcpy(&utdm_info
[ucc_num
], &utdm_primary_info
,
1027 sizeof(utdm_primary_info
));
1029 ut_info
= &utdm_info
[ucc_num
];
1030 ut_info
->uf_info
.ucc_num
= ucc_num
;
1032 sprop
= of_get_property(np
, "rx-clock-name", NULL
);
1034 ut_info
->uf_info
.rx_clock
= qe_clock_source(sprop
);
1035 if ((ut_info
->uf_info
.rx_clock
< QE_CLK_NONE
) ||
1036 (ut_info
->uf_info
.rx_clock
> QE_CLK24
)) {
1037 dev_err(&pdev
->dev
, "Invalid rx-clock-name property\n");
1041 dev_err(&pdev
->dev
, "Invalid rx-clock-name property\n");
1045 sprop
= of_get_property(np
, "tx-clock-name", NULL
);
1047 ut_info
->uf_info
.tx_clock
= qe_clock_source(sprop
);
1048 if ((ut_info
->uf_info
.tx_clock
< QE_CLK_NONE
) ||
1049 (ut_info
->uf_info
.tx_clock
> QE_CLK24
)) {
1050 dev_err(&pdev
->dev
, "Invalid tx-clock-name property\n");
1054 dev_err(&pdev
->dev
, "Invalid tx-clock-name property\n");
1058 /* use the same clock when work in loopback */
1059 if (ut_info
->uf_info
.rx_clock
== ut_info
->uf_info
.tx_clock
)
1060 qe_setbrg(ut_info
->uf_info
.rx_clock
, 20000000, 1);
1062 ret
= of_address_to_resource(np
, 0, &res
);
1066 ut_info
->uf_info
.regs
= res
.start
;
1067 ut_info
->uf_info
.irq
= irq_of_parse_and_map(np
, 0);
1069 uhdlc_priv
= kzalloc(sizeof(*uhdlc_priv
), GFP_KERNEL
);
1074 dev_set_drvdata(&pdev
->dev
, uhdlc_priv
);
1075 uhdlc_priv
->dev
= &pdev
->dev
;
1076 uhdlc_priv
->ut_info
= ut_info
;
1078 if (of_get_property(np
, "fsl,tdm-interface", NULL
))
1079 uhdlc_priv
->tsa
= 1;
1081 if (of_get_property(np
, "fsl,ucc-internal-loopback", NULL
))
1082 uhdlc_priv
->loopback
= 1;
1084 if (uhdlc_priv
->tsa
== 1) {
1085 utdm
= kzalloc(sizeof(*utdm
), GFP_KERNEL
);
1088 dev_err(&pdev
->dev
, "No mem to alloc ucc tdm data\n");
1089 goto free_uhdlc_priv
;
1091 uhdlc_priv
->utdm
= utdm
;
1092 ret
= ucc_of_parse_tdm(np
, utdm
, ut_info
);
1097 ret
= uhdlc_init(uhdlc_priv
);
1099 dev_err(&pdev
->dev
, "Failed to init uhdlc\n");
1103 dev
= alloc_hdlcdev(uhdlc_priv
);
1106 pr_err("ucc_hdlc: unable to allocate memory\n");
1107 goto undo_uhdlc_init
;
1110 uhdlc_priv
->ndev
= dev
;
1111 hdlc
= dev_to_hdlc(dev
);
1112 dev
->tx_queue_len
= 16;
1113 dev
->netdev_ops
= &uhdlc_ops
;
1114 hdlc
->attach
= ucc_hdlc_attach
;
1115 hdlc
->xmit
= ucc_hdlc_tx
;
1116 netif_napi_add(dev
, &uhdlc_priv
->napi
, ucc_hdlc_poll
, 32);
1117 if (register_hdlc_device(dev
)) {
1119 pr_err("ucc_hdlc: unable to register hdlc device\n");
1130 if (uhdlc_priv
->tsa
)
1137 static int ucc_hdlc_remove(struct platform_device
*pdev
)
1139 struct ucc_hdlc_private
*priv
= dev_get_drvdata(&pdev
->dev
);
1141 uhdlc_memclean(priv
);
1143 if (priv
->utdm
->si_regs
) {
1144 iounmap(priv
->utdm
->si_regs
);
1145 priv
->utdm
->si_regs
= NULL
;
1148 if (priv
->utdm
->siram
) {
1149 iounmap(priv
->utdm
->siram
);
1150 priv
->utdm
->siram
= NULL
;
1154 dev_info(&pdev
->dev
, "UCC based hdlc module removed\n");
1159 static const struct of_device_id fsl_ucc_hdlc_of_match
[] = {
1161 .compatible
= "fsl,ucc-hdlc",
1166 MODULE_DEVICE_TABLE(of
, fsl_ucc_hdlc_of_match
);
1168 static struct platform_driver ucc_hdlc_driver
= {
1169 .probe
= ucc_hdlc_probe
,
1170 .remove
= ucc_hdlc_remove
,
1174 .of_match_table
= fsl_ucc_hdlc_of_match
,
1178 module_platform_driver(ucc_hdlc_driver
);