diff options
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/Kconfig | 7 | ||||
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/Makefile | 2 | ||||
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/bcom_fec_rx_task.c | 78 | ||||
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/bcom_fec_tx_task.c | 91 | ||||
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/fec.c | 270 | ||||
| -rw-r--r-- | arch/powerpc/sysdev/bestcomm/fec.h | 61 |
6 files changed, 509 insertions, 0 deletions
diff --git a/arch/powerpc/sysdev/bestcomm/Kconfig b/arch/powerpc/sysdev/bestcomm/Kconfig index 9d087cefa22c..831763b0639e 100644 --- a/arch/powerpc/sysdev/bestcomm/Kconfig +++ b/arch/powerpc/sysdev/bestcomm/Kconfig | |||
| @@ -23,3 +23,10 @@ config PPC_BESTCOMM_ATA | |||
| 23 | help | 23 | help |
| 24 | This option enables the support for the ATA task. | 24 | This option enables the support for the ATA task. |
| 25 | 25 | ||
| 26 | config PPC_BESTCOMM_FEC | ||
| 27 | tristate "Bestcomm FEC tasks support" | ||
| 28 | depends on PPC_BESTCOMM | ||
| 29 | default n | ||
| 30 | help | ||
| 31 | This option enables the support for the FEC tasks. | ||
| 32 | |||
diff --git a/arch/powerpc/sysdev/bestcomm/Makefile b/arch/powerpc/sysdev/bestcomm/Makefile index b7a6a40c7d23..537d1744e6b9 100644 --- a/arch/powerpc/sysdev/bestcomm/Makefile +++ b/arch/powerpc/sysdev/bestcomm/Makefile | |||
| @@ -4,7 +4,9 @@ | |||
| 4 | 4 | ||
| 5 | bestcomm-core-objs := bestcomm.o sram.o | 5 | bestcomm-core-objs := bestcomm.o sram.o |
| 6 | bestcomm-ata-objs := ata.o bcom_ata_task.o | 6 | bestcomm-ata-objs := ata.o bcom_ata_task.o |
| 7 | bestcomm-fec-objs := fec.o bcom_fec_rx_task.o bcom_fec_tx_task.o | ||
| 7 | 8 | ||
| 8 | obj-$(CONFIG_PPC_BESTCOMM) += bestcomm-core.o | 9 | obj-$(CONFIG_PPC_BESTCOMM) += bestcomm-core.o |
| 9 | obj-$(CONFIG_PPC_BESTCOMM_ATA) += bestcomm-ata.o | 10 | obj-$(CONFIG_PPC_BESTCOMM_ATA) += bestcomm-ata.o |
| 11 | obj-$(CONFIG_PPC_BESTCOMM_FEC) += bestcomm-fec.o | ||
| 10 | 12 | ||
diff --git a/arch/powerpc/sysdev/bestcomm/bcom_fec_rx_task.c b/arch/powerpc/sysdev/bestcomm/bcom_fec_rx_task.c new file mode 100644 index 000000000000..a1ad6a02fcef --- /dev/null +++ b/arch/powerpc/sysdev/bestcomm/bcom_fec_rx_task.c | |||
| @@ -0,0 +1,78 @@ | |||
| 1 | /* | ||
| 2 | * Bestcomm FEC RX task microcode | ||
| 3 | * | ||
| 4 | * Copyright (c) 2004 Freescale Semiconductor, Inc. | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify it | ||
| 7 | * under the terms of the GNU General Public License version 2 as published | ||
| 8 | * by the Free Software Foundation. | ||
| 9 | * | ||
| 10 | * Automatically created based on BestCommAPI-2.2/code_dma/image_rtos1/dma_image.hex | ||
| 11 | * on Tue Mar 22 11:19:38 2005 GMT | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <asm/types.h> | ||
| 15 | |||
| 16 | /* | ||
| 17 | * The header consists of the following fields: | ||
| 18 | * u32 magic; | ||
| 19 | * u8 desc_size; | ||
| 20 | * u8 var_size; | ||
| 21 | * u8 inc_size; | ||
| 22 | * u8 first_var; | ||
| 23 | * u8 reserved[8]; | ||
| 24 | * | ||
| 25 | * The size fields contain the number of 32-bit words. | ||
| 26 | */ | ||
| 27 | |||
| 28 | u32 bcom_fec_rx_task[] = { | ||
| 29 | /* header */ | ||
| 30 | 0x4243544b, | ||
| 31 | 0x18060709, | ||
| 32 | 0x00000000, | ||
| 33 | 0x00000000, | ||
| 34 | |||
| 35 | /* Task descriptors */ | ||
| 36 | 0x808220e3, /* LCD: idx0 = var1, idx1 = var4; idx1 <= var3; idx0 += inc4, idx1 += inc3 */ | ||
| 37 | 0x10601010, /* DRD1A: var4 = var2; FN=0 MORE init=3 WS=0 RS=0 */ | ||
| 38 | 0xb8800264, /* LCD: idx2 = *idx1, idx3 = var0; idx2 < var9; idx2 += inc4, idx3 += inc4 */ | ||
| 39 | 0x10001308, /* DRD1A: var4 = idx1; FN=0 MORE init=0 WS=0 RS=0 */ | ||
| 40 | 0x60140002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT init=0 WS=2 RS=2 */ | ||
| 41 | 0x0cccfcca, /* DRD2B1: *idx3 = EU3(); EU3(*idx3,var10) */ | ||
| 42 | 0x80004000, /* LCDEXT: idx2 = 0x00000000; ; */ | ||
| 43 | 0xb8c58029, /* LCD: idx3 = *(idx1 + var00000015); idx3 once var0; idx3 += inc5 */ | ||
| 44 | 0x60000002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT init=0 WS=0 RS=0 */ | ||
| 45 | 0x088cf8cc, /* DRD2B1: idx2 = EU3(); EU3(idx3,var12) */ | ||
| 46 | 0x991982f2, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var11; idx2 += inc6, idx3 += inc2 */ | ||
| 47 | 0x006acf80, /* DRD1A: *idx3 = *idx0; FN=0 init=3 WS=1 RS=1 */ | ||
| 48 | 0x80004000, /* LCDEXT: idx2 = 0x00000000; ; */ | ||
| 49 | 0x9999802d, /* LCD: idx3 = idx3; idx3 once var0; idx3 += inc5 */ | ||
| 50 | 0x70000002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT MORE init=0 WS=0 RS=0 */ | ||
| 51 | 0x034cfc4e, /* DRD2B1: var13 = EU3(); EU3(*idx1,var14) */ | ||
| 52 | 0x00008868, /* DRD1A: idx2 = var13; FN=0 init=0 WS=0 RS=0 */ | ||
| 53 | 0x99198341, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var13; idx2 += inc0, idx3 += inc1 */ | ||
| 54 | 0x007ecf80, /* DRD1A: *idx3 = *idx0; FN=0 init=3 WS=3 RS=3 */ | ||
| 55 | 0x99198272, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var9; idx2 += inc6, idx3 += inc2 */ | ||
| 56 | 0x046acf80, /* DRD1A: *idx3 = *idx0; FN=0 INT init=3 WS=1 RS=1 */ | ||
| 57 | 0x9819002d, /* LCD: idx2 = idx0; idx2 once var0; idx2 += inc5 */ | ||
| 58 | 0x0060c790, /* DRD1A: *idx1 = *idx2; FN=0 init=3 WS=0 RS=0 */ | ||
| 59 | 0x000001f8, /* NOP */ | ||
| 60 | |||
| 61 | /* VAR[9]-VAR[14] */ | ||
| 62 | 0x40000000, | ||
| 63 | 0x7fff7fff, | ||
| 64 | 0x00000000, | ||
| 65 | 0x00000003, | ||
| 66 | 0x40000008, | ||
| 67 | 0x43ffffff, | ||
| 68 | |||
| 69 | /* INC[0]-INC[6] */ | ||
| 70 | 0x40000000, | ||
| 71 | 0xe0000000, | ||
| 72 | 0xe0000000, | ||
| 73 | 0xa0000008, | ||
| 74 | 0x20000000, | ||
| 75 | 0x00000000, | ||
| 76 | 0x4000ffff, | ||
| 77 | }; | ||
| 78 | |||
diff --git a/arch/powerpc/sysdev/bestcomm/bcom_fec_tx_task.c b/arch/powerpc/sysdev/bestcomm/bcom_fec_tx_task.c new file mode 100644 index 000000000000..b1c495c3a65a --- /dev/null +++ b/arch/powerpc/sysdev/bestcomm/bcom_fec_tx_task.c | |||
| @@ -0,0 +1,91 @@ | |||
| 1 | /* | ||
| 2 | * Bestcomm FEC TX task microcode | ||
| 3 | * | ||
| 4 | * Copyright (c) 2004 Freescale Semiconductor, Inc. | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or modify it | ||
| 7 | * under the terms of the GNU General Public License version 2 as published | ||
| 8 | * by the Free Software Foundation. | ||
| 9 | * | ||
| 10 | * Automatically created based on BestCommAPI-2.2/code_dma/image_rtos1/dma_image.hex | ||
| 11 | * on Tue Mar 22 11:19:29 2005 GMT | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <asm/types.h> | ||
| 15 | |||
| 16 | /* | ||
| 17 | * The header consists of the following fields: | ||
| 18 | * u32 magic; | ||
| 19 | * u8 desc_size; | ||
| 20 | * u8 var_size; | ||
| 21 | * u8 inc_size; | ||
| 22 | * u8 first_var; | ||
| 23 | * u8 reserved[8]; | ||
| 24 | * | ||
| 25 | * The size fields contain the number of 32-bit words. | ||
| 26 | */ | ||
| 27 | |||
| 28 | u32 bcom_fec_tx_task[] = { | ||
| 29 | /* header */ | ||
| 30 | 0x4243544b, | ||
| 31 | 0x2407070d, | ||
| 32 | 0x00000000, | ||
| 33 | 0x00000000, | ||
| 34 | |||
| 35 | /* Task descriptors */ | ||
| 36 | 0x8018001b, /* LCD: idx0 = var0; idx0 <= var0; idx0 += inc3 */ | ||
| 37 | 0x60000005, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=5 EXT init=0 WS=0 RS=0 */ | ||
| 38 | 0x01ccfc0d, /* DRD2B1: var7 = EU3(); EU3(*idx0,var13) */ | ||
| 39 | 0x8082a123, /* LCD: idx0 = var1, idx1 = var5; idx1 <= var4; idx0 += inc4, idx1 += inc3 */ | ||
| 40 | 0x10801418, /* DRD1A: var5 = var3; FN=0 MORE init=4 WS=0 RS=0 */ | ||
| 41 | 0xf88103a4, /* LCDEXT: idx2 = *idx1, idx3 = var2; idx2 < var14; idx2 += inc4, idx3 += inc4 */ | ||
| 42 | 0x801a6024, /* LCD: idx4 = var0; ; idx4 += inc4 */ | ||
| 43 | 0x10001708, /* DRD1A: var5 = idx1; FN=0 MORE init=0 WS=0 RS=0 */ | ||
| 44 | 0x60140002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT init=0 WS=2 RS=2 */ | ||
| 45 | 0x0cccfccf, /* DRD2B1: *idx3 = EU3(); EU3(*idx3,var15) */ | ||
| 46 | 0x991a002c, /* LCD: idx2 = idx2, idx3 = idx4; idx2 once var0; idx2 += inc5, idx3 += inc4 */ | ||
| 47 | 0x70000002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT MORE init=0 WS=0 RS=0 */ | ||
| 48 | 0x024cfc4d, /* DRD2B1: var9 = EU3(); EU3(*idx1,var13) */ | ||
| 49 | 0x60000003, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=3 EXT init=0 WS=0 RS=0 */ | ||
| 50 | 0x0cccf247, /* DRD2B1: *idx3 = EU3(); EU3(var9,var7) */ | ||
| 51 | 0x80004000, /* LCDEXT: idx2 = 0x00000000; ; */ | ||
| 52 | 0xb8c80029, /* LCD: idx3 = *(idx1 + var0000001a); idx3 once var0; idx3 += inc5 */ | ||
| 53 | 0x70000002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT MORE init=0 WS=0 RS=0 */ | ||
| 54 | 0x088cf8d1, /* DRD2B1: idx2 = EU3(); EU3(idx3,var17) */ | ||
| 55 | 0x00002f10, /* DRD1A: var11 = idx2; FN=0 init=0 WS=0 RS=0 */ | ||
| 56 | 0x99198432, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var16; idx2 += inc6, idx3 += inc2 */ | ||
| 57 | 0x008ac398, /* DRD1A: *idx0 = *idx3; FN=0 init=4 WS=1 RS=1 */ | ||
| 58 | 0x80004000, /* LCDEXT: idx2 = 0x00000000; ; */ | ||
| 59 | 0x9999802d, /* LCD: idx3 = idx3; idx3 once var0; idx3 += inc5 */ | ||
| 60 | 0x70000002, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=2 EXT MORE init=0 WS=0 RS=0 */ | ||
| 61 | 0x048cfc53, /* DRD2B1: var18 = EU3(); EU3(*idx1,var19) */ | ||
| 62 | 0x60000008, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=8 EXT init=0 WS=0 RS=0 */ | ||
| 63 | 0x088cf48b, /* DRD2B1: idx2 = EU3(); EU3(var18,var11) */ | ||
| 64 | 0x99198481, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var18; idx2 += inc0, idx3 += inc1 */ | ||
| 65 | 0x009ec398, /* DRD1A: *idx0 = *idx3; FN=0 init=4 WS=3 RS=3 */ | ||
| 66 | 0x991983b2, /* LCD: idx2 = idx2, idx3 = idx3; idx2 > var14; idx2 += inc6, idx3 += inc2 */ | ||
| 67 | 0x088ac398, /* DRD1A: *idx0 = *idx3; FN=0 TFD init=4 WS=1 RS=1 */ | ||
| 68 | 0x9919002d, /* LCD: idx2 = idx2; idx2 once var0; idx2 += inc5 */ | ||
| 69 | 0x60000005, /* DRD2A: EU0=0 EU1=0 EU2=0 EU3=5 EXT init=0 WS=0 RS=0 */ | ||
| 70 | 0x0c4cf88e, /* DRD2B1: *idx1 = EU3(); EU3(idx2,var14) */ | ||
| 71 | 0x000001f8, /* NOP */ | ||
| 72 | |||
| 73 | /* VAR[13]-VAR[19] */ | ||
| 74 | 0x0c000000, | ||
| 75 | 0x40000000, | ||
| 76 | 0x7fff7fff, | ||
| 77 | 0x00000000, | ||
| 78 | 0x00000003, | ||
| 79 | 0x40000004, | ||
| 80 | 0x43ffffff, | ||
| 81 | |||
| 82 | /* INC[0]-INC[6] */ | ||
| 83 | 0x40000000, | ||
| 84 | 0xe0000000, | ||
| 85 | 0xe0000000, | ||
| 86 | 0xa0000008, | ||
| 87 | 0x20000000, | ||
| 88 | 0x00000000, | ||
| 89 | 0x4000ffff, | ||
| 90 | }; | ||
| 91 | |||
diff --git a/arch/powerpc/sysdev/bestcomm/fec.c b/arch/powerpc/sysdev/bestcomm/fec.c new file mode 100644 index 000000000000..957a988d23ea --- /dev/null +++ b/arch/powerpc/sysdev/bestcomm/fec.c | |||
| @@ -0,0 +1,270 @@ | |||
| 1 | /* | ||
| 2 | * Bestcomm FEC tasks driver | ||
| 3 | * | ||
| 4 | * | ||
| 5 | * Copyright (C) 2006-2007 Sylvain Munaut <tnt@246tNt.com> | ||
| 6 | * Copyright (C) 2003-2004 MontaVista, Software, Inc. | ||
| 7 | * ( by Dale Farnsworth <dfarnsworth@mvista.com> ) | ||
| 8 | * | ||
| 9 | * This file is licensed under the terms of the GNU General Public License | ||
| 10 | * version 2. This program is licensed "as is" without any warranty of any | ||
| 11 | * kind, whether express or implied. | ||
| 12 | */ | ||
| 13 | |||
| 14 | #include <linux/kernel.h> | ||
| 15 | #include <linux/module.h> | ||
| 16 | #include <linux/types.h> | ||
| 17 | #include <asm/io.h> | ||
| 18 | |||
| 19 | #include "bestcomm.h" | ||
| 20 | #include "bestcomm_priv.h" | ||
| 21 | #include "fec.h" | ||
| 22 | |||
| 23 | |||
| 24 | /* ======================================================================== */ | ||
| 25 | /* Task image/var/inc */ | ||
| 26 | /* ======================================================================== */ | ||
| 27 | |||
| 28 | /* fec tasks images */ | ||
| 29 | extern u32 bcom_fec_rx_task[]; | ||
| 30 | extern u32 bcom_fec_tx_task[]; | ||
| 31 | |||
| 32 | /* rx task vars that need to be set before enabling the task */ | ||
| 33 | struct bcom_fec_rx_var { | ||
| 34 | u32 enable; /* (u16*) address of task's control register */ | ||
| 35 | u32 fifo; /* (u32*) address of fec's fifo */ | ||
| 36 | u32 bd_base; /* (struct bcom_bd*) beginning of ring buffer */ | ||
| 37 | u32 bd_last; /* (struct bcom_bd*) end of ring buffer */ | ||
| 38 | u32 bd_start; /* (struct bcom_bd*) current bd */ | ||
| 39 | u32 buffer_size; /* size of receive buffer */ | ||
| 40 | }; | ||
| 41 | |||
| 42 | /* rx task incs that need to be set before enabling the task */ | ||
| 43 | struct bcom_fec_rx_inc { | ||
| 44 | u16 pad0; | ||
| 45 | s16 incr_bytes; | ||
| 46 | u16 pad1; | ||
| 47 | s16 incr_dst; | ||
| 48 | u16 pad2; | ||
| 49 | s16 incr_dst_ma; | ||
| 50 | }; | ||
| 51 | |||
| 52 | /* tx task vars that need to be set before enabling the task */ | ||
| 53 | struct bcom_fec_tx_var { | ||
| 54 | u32 DRD; /* (u32*) address of self-modified DRD */ | ||
| 55 | u32 fifo; /* (u32*) address of fec's fifo */ | ||
| 56 | u32 enable; /* (u16*) address of task's control register */ | ||
| 57 | u32 bd_base; /* (struct bcom_bd*) beginning of ring buffer */ | ||
| 58 | u32 bd_last; /* (struct bcom_bd*) end of ring buffer */ | ||
| 59 | u32 bd_start; /* (struct bcom_bd*) current bd */ | ||
| 60 | u32 buffer_size; /* set by uCode for each packet */ | ||
| 61 | }; | ||
| 62 | |||
| 63 | /* tx task incs that need to be set before enabling the task */ | ||
| 64 | struct bcom_fec_tx_inc { | ||
| 65 | u16 pad0; | ||
| 66 | s16 incr_bytes; | ||
| 67 | u16 pad1; | ||
| 68 | s16 incr_src; | ||
| 69 | u16 pad2; | ||
| 70 | s16 incr_src_ma; | ||
| 71 | }; | ||
| 72 | |||
| 73 | /* private structure in the task */ | ||
| 74 | struct bcom_fec_priv { | ||
| 75 | phys_addr_t fifo; | ||
| 76 | int maxbufsize; | ||
| 77 | }; | ||
| 78 | |||
| 79 | |||
| 80 | /* ======================================================================== */ | ||
| 81 | /* Task support code */ | ||
| 82 | /* ======================================================================== */ | ||
| 83 | |||
| 84 | struct bcom_task * | ||
| 85 | bcom_fec_rx_init(int queue_len, phys_addr_t fifo, int maxbufsize) | ||
| 86 | { | ||
| 87 | struct bcom_task *tsk; | ||
| 88 | struct bcom_fec_priv *priv; | ||
| 89 | |||
| 90 | tsk = bcom_task_alloc(queue_len, sizeof(struct bcom_fec_bd), | ||
| 91 | sizeof(struct bcom_fec_priv)); | ||
| 92 | if (!tsk) | ||
| 93 | return NULL; | ||
| 94 | |||
| 95 | tsk->flags = BCOM_FLAGS_NONE; | ||
| 96 | |||
| 97 | priv = tsk->priv; | ||
| 98 | priv->fifo = fifo; | ||
| 99 | priv->maxbufsize = maxbufsize; | ||
| 100 | |||
| 101 | if (bcom_fec_rx_reset(tsk)) { | ||
| 102 | bcom_task_free(tsk); | ||
| 103 | return NULL; | ||
| 104 | } | ||
| 105 | |||
| 106 | return tsk; | ||
| 107 | } | ||
| 108 | EXPORT_SYMBOL_GPL(bcom_fec_rx_init); | ||
| 109 | |||
| 110 | int | ||
| 111 | bcom_fec_rx_reset(struct bcom_task *tsk) | ||
| 112 | { | ||
| 113 | struct bcom_fec_priv *priv = tsk->priv; | ||
| 114 | struct bcom_fec_rx_var *var; | ||
| 115 | struct bcom_fec_rx_inc *inc; | ||
| 116 | |||
| 117 | /* Shutdown the task */ | ||
| 118 | bcom_disable_task(tsk->tasknum); | ||
| 119 | |||
| 120 | /* Reset the microcode */ | ||
| 121 | var = (struct bcom_fec_rx_var *) bcom_task_var(tsk->tasknum); | ||
| 122 | inc = (struct bcom_fec_rx_inc *) bcom_task_inc(tsk->tasknum); | ||
| 123 | |||
| 124 | if (bcom_load_image(tsk->tasknum, bcom_fec_rx_task)) | ||
| 125 | return -1; | ||
| 126 | |||
| 127 | var->enable = bcom_eng->regs_base + | ||
| 128 | offsetof(struct mpc52xx_sdma, tcr[tsk->tasknum]); | ||
| 129 | var->fifo = (u32) priv->fifo; | ||
| 130 | var->bd_base = tsk->bd_pa; | ||
| 131 | var->bd_last = tsk->bd_pa + ((tsk->num_bd-1) * tsk->bd_size); | ||
| 132 | var->bd_start = tsk->bd_pa; | ||
| 133 | var->buffer_size = priv->maxbufsize; | ||
| 134 | |||
| 135 | inc->incr_bytes = -(s16)sizeof(u32); /* These should be in the */ | ||
| 136 | inc->incr_dst = sizeof(u32); /* task image, but we stick */ | ||
| 137 | inc->incr_dst_ma= sizeof(u8); /* to the official ones */ | ||
| 138 | |||
| 139 | /* Reset the BDs */ | ||
| 140 | tsk->index = 0; | ||
| 141 | tsk->outdex = 0; | ||
| 142 | |||
| 143 | memset(tsk->bd, 0x00, tsk->num_bd * tsk->bd_size); | ||
| 144 | |||
| 145 | /* Configure some stuff */ | ||
| 146 | bcom_set_task_pragma(tsk->tasknum, BCOM_FEC_RX_BD_PRAGMA); | ||
| 147 | bcom_set_task_auto_start(tsk->tasknum, tsk->tasknum); | ||
| 148 | |||
| 149 | out_8(&bcom_eng->regs->ipr[BCOM_INITIATOR_FEC_RX], BCOM_IPR_FEC_RX); | ||
| 150 | |||
| 151 | out_be32(&bcom_eng->regs->IntPend, 1<<tsk->tasknum); /* Clear ints */ | ||
| 152 | |||
| 153 | return 0; | ||
| 154 | } | ||
| 155 | EXPORT_SYMBOL_GPL(bcom_fec_rx_reset); | ||
| 156 | |||
| 157 | void | ||
| 158 | bcom_fec_rx_release(struct bcom_task *tsk) | ||
| 159 | { | ||
| 160 | /* Nothing special for the FEC tasks */ | ||
| 161 | bcom_task_free(tsk); | ||
| 162 | } | ||
| 163 | EXPORT_SYMBOL_GPL(bcom_fec_rx_release); | ||
| 164 | |||
| 165 | |||
| 166 | |||
| 167 | /* Return 2nd to last DRD */ | ||
| 168 | /* This is an ugly hack, but at least it's only done | ||
| 169 | once at initialization */ | ||
| 170 | static u32 *self_modified_drd(int tasknum) | ||
| 171 | { | ||
| 172 | u32 *desc; | ||
| 173 | int num_descs; | ||
| 174 | int drd_count; | ||
| 175 | int i; | ||
| 176 | |||
| 177 | num_descs = bcom_task_num_descs(tasknum); | ||
| 178 | desc = bcom_task_desc(tasknum) + num_descs - 1; | ||
| 179 | drd_count = 0; | ||
| 180 | for (i=0; i<num_descs; i++, desc--) | ||
| 181 | if (bcom_desc_is_drd(*desc) && ++drd_count == 3) | ||
| 182 | break; | ||
| 183 | return desc; | ||
| 184 | } | ||
| 185 | |||
| 186 | struct bcom_task * | ||
| 187 | bcom_fec_tx_init(int queue_len, phys_addr_t fifo) | ||
| 188 | { | ||
| 189 | struct bcom_task *tsk; | ||
| 190 | struct bcom_fec_priv *priv; | ||
| 191 | |||
| 192 | tsk = bcom_task_alloc(queue_len, sizeof(struct bcom_fec_bd), | ||
| 193 | sizeof(struct bcom_fec_priv)); | ||
| 194 | if (!tsk) | ||
| 195 | return NULL; | ||
| 196 | |||
| 197 | tsk->flags = BCOM_FLAGS_ENABLE_TASK; | ||
| 198 | |||
| 199 | priv = tsk->priv; | ||
| 200 | priv->fifo = fifo; | ||
| 201 | |||
| 202 | if (bcom_fec_tx_reset(tsk)) { | ||
| 203 | bcom_task_free(tsk); | ||
| 204 | return NULL; | ||
| 205 | } | ||
| 206 | |||
| 207 | return tsk; | ||
| 208 | } | ||
| 209 | EXPORT_SYMBOL_GPL(bcom_fec_tx_init); | ||
| 210 | |||
| 211 | int | ||
| 212 | bcom_fec_tx_reset(struct bcom_task *tsk) | ||
| 213 | { | ||
| 214 | struct bcom_fec_priv *priv = tsk->priv; | ||
| 215 | struct bcom_fec_tx_var *var; | ||
| 216 | struct bcom_fec_tx_inc *inc; | ||
| 217 | |||
| 218 | /* Shutdown the task */ | ||
| 219 | bcom_disable_task(tsk->tasknum); | ||
| 220 | |||
| 221 | /* Reset the microcode */ | ||
| 222 | var = (struct bcom_fec_tx_var *) bcom_task_var(tsk->tasknum); | ||
| 223 | inc = (struct bcom_fec_tx_inc *) bcom_task_inc(tsk->tasknum); | ||
| 224 | |||
| 225 | if (bcom_load_image(tsk->tasknum, bcom_fec_tx_task)) | ||
| 226 | return -1; | ||
| 227 | |||
| 228 | var->enable = bcom_eng->regs_base + | ||
| 229 | offsetof(struct mpc52xx_sdma, tcr[tsk->tasknum]); | ||
| 230 | var->fifo = (u32) priv->fifo; | ||
| 231 | var->DRD = bcom_sram_va2pa(self_modified_drd(tsk->tasknum)); | ||
| 232 | var->bd_base = tsk->bd_pa; | ||
| 233 | var->bd_last = tsk->bd_pa + ((tsk->num_bd-1) * tsk->bd_size); | ||
| 234 | var->bd_start = tsk->bd_pa; | ||
| 235 | |||
| 236 | inc->incr_bytes = -(s16)sizeof(u32); /* These should be in the */ | ||
| 237 | inc->incr_src = sizeof(u32); /* task image, but we stick */ | ||
| 238 | inc->incr_src_ma= sizeof(u8); /* to the official ones */ | ||
| 239 | |||
| 240 | /* Reset the BDs */ | ||
| 241 | tsk->index = 0; | ||
| 242 | tsk->outdex = 0; | ||
| 243 | |||
| 244 | memset(tsk->bd, 0x00, tsk->num_bd * tsk->bd_size); | ||
| 245 | |||
| 246 | /* Configure some stuff */ | ||
| 247 | bcom_set_task_pragma(tsk->tasknum, BCOM_FEC_TX_BD_PRAGMA); | ||
| 248 | bcom_set_task_auto_start(tsk->tasknum, tsk->tasknum); | ||
| 249 | |||
| 250 | out_8(&bcom_eng->regs->ipr[BCOM_INITIATOR_FEC_TX], BCOM_IPR_FEC_TX); | ||
| 251 | |||
| 252 | out_be32(&bcom_eng->regs->IntPend, 1<<tsk->tasknum); /* Clear ints */ | ||
| 253 | |||
| 254 | return 0; | ||
| 255 | } | ||
| 256 | EXPORT_SYMBOL_GPL(bcom_fec_tx_reset); | ||
| 257 | |||
| 258 | void | ||
| 259 | bcom_fec_tx_release(struct bcom_task *tsk) | ||
| 260 | { | ||
| 261 | /* Nothing special for the FEC tasks */ | ||
| 262 | bcom_task_free(tsk); | ||
| 263 | } | ||
| 264 | EXPORT_SYMBOL_GPL(bcom_fec_tx_release); | ||
| 265 | |||
| 266 | |||
| 267 | MODULE_DESCRIPTION("BestComm FEC tasks driver"); | ||
| 268 | MODULE_AUTHOR("Dale Farnsworth <dfarnsworth@mvista.com>"); | ||
| 269 | MODULE_LICENSE("GPL v2"); | ||
| 270 | |||
diff --git a/arch/powerpc/sysdev/bestcomm/fec.h b/arch/powerpc/sysdev/bestcomm/fec.h new file mode 100644 index 000000000000..ee565d94d503 --- /dev/null +++ b/arch/powerpc/sysdev/bestcomm/fec.h | |||
| @@ -0,0 +1,61 @@ | |||
| 1 | /* | ||
| 2 | * Header for Bestcomm FEC tasks driver | ||
| 3 | * | ||
| 4 | * | ||
| 5 | * Copyright (C) 2006-2007 Sylvain Munaut <tnt@246tNt.com> | ||
| 6 | * Copyright (C) 2003-2004 MontaVista, Software, Inc. | ||
| 7 | * ( by Dale Farnsworth <dfarnsworth@mvista.com> ) | ||
| 8 | * | ||
| 9 | * This file is licensed under the terms of the GNU General Public License | ||
| 10 | * version 2. This program is licensed "as is" without any warranty of any | ||
| 11 | * kind, whether express or implied. | ||
| 12 | */ | ||
| 13 | |||
| 14 | #ifndef __BESTCOMM_FEC_H__ | ||
| 15 | #define __BESTCOMM_FEC_H__ | ||
| 16 | |||
| 17 | |||
| 18 | struct bcom_fec_bd { | ||
| 19 | u32 status; | ||
| 20 | u32 skb_pa; | ||
| 21 | }; | ||
| 22 | |||
| 23 | #define BCOM_FEC_TX_BD_TFD 0x08000000ul /* transmit frame done */ | ||
| 24 | #define BCOM_FEC_TX_BD_TC 0x04000000ul /* transmit CRC */ | ||
| 25 | #define BCOM_FEC_TX_BD_ABC 0x02000000ul /* append bad CRC */ | ||
| 26 | |||
| 27 | #define BCOM_FEC_RX_BD_L 0x08000000ul /* buffer is last in frame */ | ||
| 28 | #define BCOM_FEC_RX_BD_BC 0x00800000ul /* DA is broadcast */ | ||
| 29 | #define BCOM_FEC_RX_BD_MC 0x00400000ul /* DA is multicast and not broadcast */ | ||
| 30 | #define BCOM_FEC_RX_BD_LG 0x00200000ul /* Rx frame length violation */ | ||
| 31 | #define BCOM_FEC_RX_BD_NO 0x00100000ul /* Rx non-octet aligned frame */ | ||
| 32 | #define BCOM_FEC_RX_BD_CR 0x00040000ul /* Rx CRC error */ | ||
| 33 | #define BCOM_FEC_RX_BD_OV 0x00020000ul /* overrun */ | ||
| 34 | #define BCOM_FEC_RX_BD_TR 0x00010000ul /* Rx frame truncated */ | ||
| 35 | #define BCOM_FEC_RX_BD_LEN_MASK 0x000007fful /* mask for length of received frame */ | ||
| 36 | #define BCOM_FEC_RX_BD_ERRORS (BCOM_FEC_RX_BD_LG | BCOM_FEC_RX_BD_NO | \ | ||
| 37 | BCOM_FEC_RX_BD_CR | BCOM_FEC_RX_BD_OV | BCOM_FEC_RX_BD_TR) | ||
| 38 | |||
| 39 | |||
| 40 | extern struct bcom_task * | ||
| 41 | bcom_fec_rx_init(int queue_len, phys_addr_t fifo, int maxbufsize); | ||
| 42 | |||
| 43 | extern int | ||
| 44 | bcom_fec_rx_reset(struct bcom_task *tsk); | ||
| 45 | |||
| 46 | extern void | ||
| 47 | bcom_fec_rx_release(struct bcom_task *tsk); | ||
| 48 | |||
| 49 | |||
| 50 | extern struct bcom_task * | ||
| 51 | bcom_fec_tx_init(int queue_len, phys_addr_t fifo); | ||
| 52 | |||
| 53 | extern int | ||
| 54 | bcom_fec_tx_reset(struct bcom_task *tsk); | ||
| 55 | |||
| 56 | extern void | ||
| 57 | bcom_fec_tx_release(struct bcom_task *tsk); | ||
| 58 | |||
| 59 | |||
| 60 | #endif /* __BESTCOMM_FEC_H__ */ | ||
| 61 | |||
