Blame view

arch/mips/lantiq/xway/dma.c 6.44 KB
dfec1a827   John Crispin   MIPS: Lantiq: Add...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
  /*
   *   This program is free software; you can redistribute it and/or modify it
   *   under the terms of the GNU General Public License version 2 as published
   *   by the Free Software Foundation.
   *
   *   This program is distributed in the hope that it will be useful,
   *   but WITHOUT ANY WARRANTY; without even the implied warranty of
   *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   *   GNU General Public License for more details.
   *
   *   You should have received a copy of the GNU General Public License
   *   along with this program; if not, write to the Free Software
   *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
   *
   *   Copyright (C) 2011 John Crispin <blogic@openwrt.org>
   */
  
  #include <linux/init.h>
  #include <linux/platform_device.h>
  #include <linux/io.h>
  #include <linux/dma-mapping.h>
4af92e7a6   John Crispin   MIPS: lantiq: use...
22
  #include <linux/export.h>
dfec1a827   John Crispin   MIPS: Lantiq: Add...
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
  
  #include <lantiq_soc.h>
  #include <xway_dma.h>
  
  #define LTQ_DMA_CTRL		0x10
  #define LTQ_DMA_CPOLL		0x14
  #define LTQ_DMA_CS		0x18
  #define LTQ_DMA_CCTRL		0x1C
  #define LTQ_DMA_CDBA		0x20
  #define LTQ_DMA_CDLEN		0x24
  #define LTQ_DMA_CIS		0x28
  #define LTQ_DMA_CIE		0x2C
  #define LTQ_DMA_PS		0x40
  #define LTQ_DMA_PCTRL		0x44
  #define LTQ_DMA_IRNEN		0xf4
  
  #define DMA_DESCPT		BIT(3)		/* descriptor complete irq */
  #define DMA_TX			BIT(8)		/* TX channel direction */
  #define DMA_CHAN_ON		BIT(0)		/* channel on / off bit */
  #define DMA_PDEN		BIT(6)		/* enable packet drop */
  #define DMA_CHAN_RST		BIT(1)		/* channel on / off bit */
  #define DMA_RESET		BIT(0)		/* channel on / off bit */
  #define DMA_IRQ_ACK		0x7e		/* IRQ status register */
  #define DMA_POLL		BIT(31)		/* turn on channel polling */
  #define DMA_CLK_DIV4		BIT(6)		/* polling clock divider */
  #define DMA_2W_BURST		BIT(1)		/* 2 word burst length */
  #define DMA_MAX_CHANNEL		20		/* the soc has 20 channels */
  #define DMA_ETOP_ENDIANESS	(0xf << 8) /* endianess swap etop channels */
  #define DMA_WEIGHT	(BIT(17) | BIT(16))	/* default channel wheight */
  
  #define ltq_dma_r32(x)			ltq_r32(ltq_dma_membase + (x))
  #define ltq_dma_w32(x, y)		ltq_w32(x, ltq_dma_membase + (y))
  #define ltq_dma_w32_mask(x, y, z)	ltq_w32_mask(x, y, \
  						ltq_dma_membase + (z))
  
  static struct resource ltq_dma_resource = {
  	.name	= "dma",
  	.start	= LTQ_DMA_BASE_ADDR,
  	.end	= LTQ_DMA_BASE_ADDR + LTQ_DMA_SIZE - 1,
  	.flags  = IORESOURCE_MEM,
  };
  
  static void __iomem *ltq_dma_membase;
  
  void
  ltq_dma_enable_irq(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	local_irq_save(flags);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32_mask(0, 1 << ch->nr, LTQ_DMA_IRNEN);
  	local_irq_restore(flags);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_enable_irq);
  
  void
  ltq_dma_disable_irq(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	local_irq_save(flags);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32_mask(1 << ch->nr, 0, LTQ_DMA_IRNEN);
  	local_irq_restore(flags);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_disable_irq);
  
  void
  ltq_dma_ack_irq(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	local_irq_save(flags);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32(DMA_IRQ_ACK, LTQ_DMA_CIS);
  	local_irq_restore(flags);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_ack_irq);
  
  void
  ltq_dma_open(struct ltq_dma_channel *ch)
  {
  	unsigned long flag;
  
  	local_irq_save(flag);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32_mask(0, DMA_CHAN_ON, LTQ_DMA_CCTRL);
  	ltq_dma_enable_irq(ch);
  	local_irq_restore(flag);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_open);
  
  void
  ltq_dma_close(struct ltq_dma_channel *ch)
  {
  	unsigned long flag;
  
  	local_irq_save(flag);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32_mask(DMA_CHAN_ON, 0, LTQ_DMA_CCTRL);
  	ltq_dma_disable_irq(ch);
  	local_irq_restore(flag);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_close);
  
  static void
  ltq_dma_alloc(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	ch->desc = 0;
  	ch->desc_base = dma_alloc_coherent(NULL,
  				LTQ_DESC_NUM * LTQ_DESC_SIZE,
  				&ch->phys, GFP_ATOMIC);
  	memset(ch->desc_base, 0, LTQ_DESC_NUM * LTQ_DESC_SIZE);
  
  	local_irq_save(flags);
  	ltq_dma_w32(ch->nr, LTQ_DMA_CS);
  	ltq_dma_w32(ch->phys, LTQ_DMA_CDBA);
  	ltq_dma_w32(LTQ_DESC_NUM, LTQ_DMA_CDLEN);
  	ltq_dma_w32_mask(DMA_CHAN_ON, 0, LTQ_DMA_CCTRL);
  	wmb();
  	ltq_dma_w32_mask(0, DMA_CHAN_RST, LTQ_DMA_CCTRL);
  	while (ltq_dma_r32(LTQ_DMA_CCTRL) & DMA_CHAN_RST)
  		;
  	local_irq_restore(flags);
  }
  
  void
  ltq_dma_alloc_tx(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	ltq_dma_alloc(ch);
  
  	local_irq_save(flags);
  	ltq_dma_w32(DMA_DESCPT, LTQ_DMA_CIE);
  	ltq_dma_w32_mask(0, 1 << ch->nr, LTQ_DMA_IRNEN);
  	ltq_dma_w32(DMA_WEIGHT | DMA_TX, LTQ_DMA_CCTRL);
  	local_irq_restore(flags);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_alloc_tx);
  
  void
  ltq_dma_alloc_rx(struct ltq_dma_channel *ch)
  {
  	unsigned long flags;
  
  	ltq_dma_alloc(ch);
  
  	local_irq_save(flags);
  	ltq_dma_w32(DMA_DESCPT, LTQ_DMA_CIE);
  	ltq_dma_w32_mask(0, 1 << ch->nr, LTQ_DMA_IRNEN);
  	ltq_dma_w32(DMA_WEIGHT, LTQ_DMA_CCTRL);
  	local_irq_restore(flags);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_alloc_rx);
  
  void
  ltq_dma_free(struct ltq_dma_channel *ch)
  {
  	if (!ch->desc_base)
  		return;
  	ltq_dma_close(ch);
  	dma_free_coherent(NULL, LTQ_DESC_NUM * LTQ_DESC_SIZE,
  		ch->desc_base, ch->phys);
  }
  EXPORT_SYMBOL_GPL(ltq_dma_free);
  
  void
  ltq_dma_init_port(int p)
  {
  	ltq_dma_w32(p, LTQ_DMA_PS);
  	switch (p) {
  	case DMA_PORT_ETOP:
  		/*
  		 * Tell the DMA engine to swap the endianess of data frames and
  		 * drop packets if the channel arbitration fails.
  		 */
  		ltq_dma_w32_mask(0, DMA_ETOP_ENDIANESS | DMA_PDEN,
  			LTQ_DMA_PCTRL);
  		break;
  
  	case DMA_PORT_DEU:
  		ltq_dma_w32((DMA_2W_BURST << 4) | (DMA_2W_BURST << 2),
  			LTQ_DMA_PCTRL);
  		break;
  
  	default:
  		break;
  	}
  }
  EXPORT_SYMBOL_GPL(ltq_dma_init_port);
  
  int __init
  ltq_dma_init(void)
  {
  	int i;
  
  	/* insert and request the memory region */
  	if (insert_resource(&iomem_resource, &ltq_dma_resource) < 0)
ab75dc02c   Ralf Baechle   MIPS: Fix up inco...
225
  		panic("Failed to insert dma memory");
dfec1a827   John Crispin   MIPS: Lantiq: Add...
226
227
228
  
  	if (request_mem_region(ltq_dma_resource.start,
  			resource_size(&ltq_dma_resource), "dma") < 0)
ab75dc02c   Ralf Baechle   MIPS: Fix up inco...
229
  		panic("Failed to request dma memory");
dfec1a827   John Crispin   MIPS: Lantiq: Add...
230
231
232
233
234
  
  	/* remap dma register range */
  	ltq_dma_membase = ioremap_nocache(ltq_dma_resource.start,
  				resource_size(&ltq_dma_resource));
  	if (!ltq_dma_membase)
ab75dc02c   Ralf Baechle   MIPS: Fix up inco...
235
  		panic("Failed to remap dma memory");
dfec1a827   John Crispin   MIPS: Lantiq: Add...
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
  
  	/* power up and reset the dma engine */
  	ltq_pmu_enable(PMU_DMA);
  	ltq_dma_w32_mask(0, DMA_RESET, LTQ_DMA_CTRL);
  
  	/* disable all interrupts */
  	ltq_dma_w32(0, LTQ_DMA_IRNEN);
  
  	/* reset/configure each channel */
  	for (i = 0; i < DMA_MAX_CHANNEL; i++) {
  		ltq_dma_w32(i, LTQ_DMA_CS);
  		ltq_dma_w32(DMA_CHAN_RST, LTQ_DMA_CCTRL);
  		ltq_dma_w32(DMA_POLL | DMA_CLK_DIV4, LTQ_DMA_CPOLL);
  		ltq_dma_w32_mask(DMA_CHAN_ON, 0, LTQ_DMA_CCTRL);
  	}
  	return 0;
  }
  
  postcore_initcall(ltq_dma_init);