• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /***************************************************************************
2  *            au88x0_cxtalk.c
3  *
4  *  Wed Nov 19 16:29:47 2003
5  *  Copyright  2003  mjander
6  *  mjander@users.sourceforge.org
7  ****************************************************************************/
8 
9 /*
10  *  This program is free software; you can redistribute it and/or modify
11  *  it under the terms of the GNU General Public License as published by
12  *  the Free Software Foundation; either version 2 of the License, or
13  *  (at your option) any later version.
14  *
15  *  This program is distributed in the hope that it will be useful,
16  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
17  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  *  GNU Library General Public License for more details.
19  *
20  *  You should have received a copy of the GNU General Public License
21  *  along with this program; if not, write to the Free Software
22  *  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23  */
24 
25 #include "au88x0_xtalk.h"
26 
27 /* Data (a whole lot of data.... ) */
28 
29 static short const sXtalkWideKLeftEq = 0x269C;
30 static short const sXtalkWideKRightEq = 0x269C;
31 static short const sXtalkWideKLeftXt = 0xF25E;
32 static short const sXtalkWideKRightXt = 0xF25E;
33 static short const sXtalkWideShiftLeftEq = 1;
34 static short const sXtalkWideShiftRightEq = 1;
35 static short const sXtalkWideShiftLeftXt = 0;
36 static short const sXtalkWideShiftRightXt = 0;
37 static unsigned short const wXtalkWideLeftDelay = 0xd;
38 static unsigned short const wXtalkWideRightDelay = 0xd;
39 static short const sXtalkNarrowKLeftEq = 0x468D;
40 static short const sXtalkNarrowKRightEq = 0x468D;
41 static short const sXtalkNarrowKLeftXt = 0xF82E;
42 static short const sXtalkNarrowKRightXt = 0xF82E;
43 static short const sXtalkNarrowShiftLeftEq = 0x3;
44 static short const sXtalkNarrowShiftRightEq = 0x3;
45 static short const sXtalkNarrowShiftLeftXt = 0;
46 static short const sXtalkNarrowShiftRightXt = 0;
47 static unsigned short const wXtalkNarrowLeftDelay = 0x7;
48 static unsigned short const wXtalkNarrowRightDelay = 0x7;
49 
50 static xtalk_gains_t const asXtalkGainsDefault = {
51 	0x4000, 0x4000, 0x4000, 0x4000, 0x4000,
52 	0x4000, 0x4000, 0x4000, 0x4000,	0x4000
53 };
54 
55 static xtalk_gains_t const asXtalkGainsTest = {
56 	0x7fff, 0x8000, 0x0000, 0x0000, 0x0001,
57 	0xffff, 0x4000, 0xc000, 0x0002, 0xfffe
58 };
59 
60 static xtalk_gains_t const asXtalkGains1Chan = {
61 	0x7FFF, 0, 0, 0, 0,
62 	0x7FFF, 0, 0, 0, 0,
63 };
64 
65 // Input gain for 4 A3D slices. One possible input pair is left zero.
66 static xtalk_gains_t const asXtalkGainsAllChan = {
67 	0x7FFF, 0x7FFF, 0x7FFF, 0x7FFF, 0,
68 	0x7FFF, 0x7FFF, 0x7FFF, 0x7FFF,	0
69 };
70 
71 static xtalk_gains_t const asXtalkGainsZeros = {
72 	0, 0, 0, 0, 0, 0, 0, 0, 0, 0
73 };
74 
75 static xtalk_dline_t const alXtalkDlineZeros = {
76 	0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
77 	0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
78 };
79 static xtalk_dline_t const alXtalkDlineTest = {
80 	0x0000fc18, 0xfff03e8, 0x000186a0, 0xfffe7960, 1, 0xffffffff, 0, 0,
81 	0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
82 	0, 0, 0, 0, 0, 0, 0, 0
83 };
84 
85 static xtalk_instate_t const asXtalkInStateZeros = {
86 	0, 0, 0, 0
87 };
88 
89 static xtalk_instate_t const asXtalkInStateTest = {
90 	0x0080, 0xff80, 0x0001, 0xffff
91 };
92 
93 static xtalk_state_t const asXtalkOutStateZeros = {
94 	{0, 0, 0, 0},
95 	{0, 0, 0, 0},
96 	{0, 0, 0, 0},
97 	{0, 0, 0, 0},
98 	{0, 0, 0, 0}
99 };
100 
101 static short const sDiamondKLeftEq = 0x401d;
102 static short const sDiamondKRightEq = 0x401d;
103 static short const sDiamondKLeftXt = 0xF90E;
104 static short const sDiamondKRightXt = 0xF90E;
105 static short const sDiamondShiftLeftEq = 1;
106 static short const sDiamondShiftRightEq = 1;
107 static short const sDiamondShiftLeftXt = 0;
108 static short const sDiamondShiftRightXt = 0;
109 static unsigned short const wDiamondLeftDelay = 0xb;
110 static unsigned short const wDiamondRightDelay = 0xb;
111 
112 static xtalk_coefs_t const asXtalkWideCoefsLeftEq = {
113 	{0xEC4C, 0xDCE9, 0xFDC2, 0xFEEC, 0},
114 	{0x5F60, 0xCBCB, 0xFC26, 0x0305, 0},
115 	{0x340B, 0xe8f5, 0x236c, 0xe40d, 0},
116 	{0x76d5, 0xc78d, 0x05ac, 0xfa5b, 0},
117 	{0x7F04, 0xC0FA, 0x0263, 0xFDA2, 0}
118 };
119 static xtalk_coefs_t const asXtalkWideCoefsRightEq = {
120 	{0xEC4C, 0xDCE9, 0xFDC2, 0xFEEC, 0},
121 	{0x5F60, 0xCBCB, 0xFC26, 0x0305, 0},
122 	{0x340B, 0xe8f5, 0x236c, 0xe40d, 0},
123 	{0x76d5, 0xc78d, 0x05ac, 0xfa5b, 0},
124 	{0x7F04, 0xC0FA, 0x0263, 0xFDA2, 0}
125 };
126 static xtalk_coefs_t const asXtalkWideCoefsLeftXt = {
127 	{0x55c6, 0xc97b, 0x005b, 0x0047, 0},
128 	{0x6a60, 0xca20, 0xffc6, 0x0040, 0},
129 	{0x6411, 0xd711, 0xfca1, 0x0190, 0},
130 	{0x77dc, 0xc79e, 0xffb8, 0x000a, 0},
131 	{0, 0, 0, 0, 0}
132 };
133 static xtalk_coefs_t const asXtalkWideCoefsRightXt = {
134 	{0x55c6, 0xc97b, 0x005b, 0x0047, 0},
135 	{0x6a60, 0xca20, 0xffc6, 0x0040, 0},
136 	{0x6411, 0xd711, 0xfca1, 0x0190, 0},
137 	{0x77dc, 0xc79e, 0xffb8, 0x000a, 0},
138 	{0, 0, 0, 0, 0}
139 };
140 static xtalk_coefs_t const asXtalkNarrowCoefsLeftEq = {
141 	{0x50B5, 0xD07C, 0x026D, 0xFD21, 0},
142 	{0x460F, 0xE44F, 0xF75E, 0xEFA6, 0},
143 	{0x556D, 0xDCAB, 0x2098, 0xF0F2, 0},
144 	{0x7E03, 0xC1F0, 0x007D, 0xFF89, 0},
145 	{0x383E, 0xFD9D, 0xB278, 0x4547, 0}
146 };
147 
148 static xtalk_coefs_t const asXtalkNarrowCoefsRightEq = {
149 	{0x50B5, 0xD07C, 0x026D, 0xFD21, 0},
150 	{0x460F, 0xE44F, 0xF75E, 0xEFA6, 0},
151 	{0x556D, 0xDCAB, 0x2098, 0xF0F2, 0},
152 	{0x7E03, 0xC1F0, 0x007D, 0xFF89, 0},
153 	{0x383E, 0xFD9D, 0xB278, 0x4547, 0}
154 };
155 
156 static xtalk_coefs_t const asXtalkNarrowCoefsLeftXt = {
157 	{0x3CB2, 0xDF49, 0xF6EA, 0x095B, 0},
158 	{0x6777, 0xC915, 0xFEAF, 0x00B1, 0},
159 	{0x7762, 0xC7D9, 0x025B, 0xFDA6, 0},
160 	{0x6B7A, 0xD2AA, 0xF2FB, 0x0B64, 0},
161 	{0, 0, 0, 0, 0}
162 };
163 
164 static xtalk_coefs_t const asXtalkNarrowCoefsRightXt = {
165 	{0x3CB2, 0xDF49, 0xF6EA, 0x095B, 0},
166 	{0x6777, 0xC915, 0xFEAF, 0x00B1, 0},
167 	{0x7762, 0xC7D9, 0x025B, 0xFDA6, 0},
168 	{0x6B7A, 0xD2AA, 0xF2FB, 0x0B64, 0},
169 	{0, 0, 0, 0, 0}
170 };
171 
172 static xtalk_coefs_t const asXtalkCoefsZeros = {
173 	{0, 0, 0, 0, 0},
174 	{0, 0, 0, 0, 0},
175 	{0, 0, 0, 0, 0},
176 	{0, 0, 0, 0, 0},
177 	{0, 0, 0, 0, 0}
178 };
179 
180 static xtalk_coefs_t const asXtalkCoefsPipe = {
181 	{0, 0, 0x0FA0, 0, 0},
182 	{0, 0, 0x0FA0, 0, 0},
183 	{0, 0, 0x0FA0, 0, 0},
184 	{0, 0, 0x0FA0, 0, 0},
185 	{0, 0, 0x1180, 0, 0},
186 };
187 static xtalk_coefs_t const asXtalkCoefsNegPipe = {
188 	{0, 0, 0xF380, 0, 0},
189 	{0, 0, 0xF380, 0, 0},
190 	{0, 0, 0xF380, 0, 0},
191 	{0, 0, 0xF380, 0, 0},
192 	{0, 0, 0xF200, 0, 0}
193 };
194 
195 static xtalk_coefs_t const asXtalkCoefsNumTest = {
196 	{0, 0, 0xF380, 0x8000, 0x6D60},
197 	{0, 0, 0, 0, 0},
198 	{0, 0, 0, 0, 0},
199 	{0, 0, 0, 0, 0},
200 	{0, 0, 0, 0, 0}
201 };
202 
203 static xtalk_coefs_t const asXtalkCoefsDenTest = {
204 	{0xC000, 0x2000, 0x4000, 0, 0},
205 	{0, 0, 0, 0, 0},
206 	{0, 0, 0, 0, 0},
207 	{0, 0, 0, 0, 0},
208 	{0, 0, 0, 0, 0}
209 };
210 
211 static xtalk_state_t const asXtalkOutStateTest = {
212 	{0x7FFF, 0x0004, 0xFFFC, 0},
213 	{0xFE00, 0x0008, 0xFFF8, 0x4000},
214 	{0x0200, 0x0010, 0xFFF0, 0xC000},
215 	{0x8000, 0x0020, 0xFFE0, 0},
216 	{0, 0, 0, 0}
217 };
218 
219 static xtalk_coefs_t const asDiamondCoefsLeftEq = {
220 	{0x0F1E, 0x2D05, 0xF8E3, 0x07C8, 0},
221 	{0x45E2, 0xCA51, 0x0448, 0xFCE7, 0},
222 	{0xA93E, 0xDBD5, 0x022C, 0x028A, 0},
223 	{0, 0, 0, 0, 0},
224 	{0, 0, 0, 0, 0}
225 };
226 
227 static xtalk_coefs_t const asDiamondCoefsRightEq = {
228 	{0x0F1E, 0x2D05, 0xF8E3, 0x07C8, 0},
229 	{0x45E2, 0xCA51, 0x0448, 0xFCE7, 0},
230 	{0xA93E, 0xDBD5, 0x022C, 0x028A, 0},
231 	{0, 0, 0, 0, 0},
232 	{0, 0, 0, 0, 0}
233 };
234 
235 static xtalk_coefs_t const asDiamondCoefsLeftXt = {
236 	{0x3B50, 0xFE08, 0xF959, 0x0060, 0},
237 	{0x9FCB, 0xD8F1, 0x00A2, 0x003A, 0},
238 	{0, 0, 0, 0, 0},
239 	{0, 0, 0, 0, 0},
240 	{0, 0, 0, 0, 0}
241 };
242 
243 static xtalk_coefs_t const asDiamondCoefsRightXt = {
244 	{0x3B50, 0xFE08, 0xF959, 0x0060, 0},
245 	{0x9FCB, 0xD8F1, 0x00A2, 0x003A, 0},
246 	{0, 0, 0, 0, 0},
247 	{0, 0, 0, 0, 0},
248 	{0, 0, 0, 0, 0}
249 };
250 
251  /**/
252 /* XTalk EQ and XT */
253 static void
vortex_XtalkHw_SetLeftEQ(vortex_t * vortex,short arg_0,short arg_4,xtalk_coefs_t const coefs)254 vortex_XtalkHw_SetLeftEQ(vortex_t * vortex, short arg_0, short arg_4,
255 			 xtalk_coefs_t const coefs)
256 {
257 	int i;
258 
259 	for (i = 0; i < 5; i++) {
260 		hwwrite(vortex->mmio, 0x24200 + i * 0x24, coefs[i][0]);
261 		hwwrite(vortex->mmio, 0x24204 + i * 0x24, coefs[i][1]);
262 		hwwrite(vortex->mmio, 0x24208 + i * 0x24, coefs[i][2]);
263 		hwwrite(vortex->mmio, 0x2420c + i * 0x24, coefs[i][3]);
264 		hwwrite(vortex->mmio, 0x24210 + i * 0x24, coefs[i][4]);
265 	}
266 	hwwrite(vortex->mmio, 0x24538, arg_0 & 0xffff);
267 	hwwrite(vortex->mmio, 0x2453C, arg_4 & 0xffff);
268 }
269 
270 static void
vortex_XtalkHw_SetRightEQ(vortex_t * vortex,short arg_0,short arg_4,xtalk_coefs_t const coefs)271 vortex_XtalkHw_SetRightEQ(vortex_t * vortex, short arg_0, short arg_4,
272 			  xtalk_coefs_t const coefs)
273 {
274 	int i;
275 
276 	for (i = 0; i < 5; i++) {
277 		hwwrite(vortex->mmio, 0x242b4 + i * 0x24, coefs[i][0]);
278 		hwwrite(vortex->mmio, 0x242b8 + i * 0x24, coefs[i][1]);
279 		hwwrite(vortex->mmio, 0x242bc + i * 0x24, coefs[i][2]);
280 		hwwrite(vortex->mmio, 0x242c0 + i * 0x24, coefs[i][3]);
281 		hwwrite(vortex->mmio, 0x242c4 + i * 0x24, coefs[i][4]);
282 	}
283 	hwwrite(vortex->mmio, 0x24540, arg_0 & 0xffff);
284 	hwwrite(vortex->mmio, 0x24544, arg_4 & 0xffff);
285 }
286 
287 static void
vortex_XtalkHw_SetLeftXT(vortex_t * vortex,short arg_0,short arg_4,xtalk_coefs_t const coefs)288 vortex_XtalkHw_SetLeftXT(vortex_t * vortex, short arg_0, short arg_4,
289 			 xtalk_coefs_t const coefs)
290 {
291 	int i;
292 
293 	for (i = 0; i < 5; i++) {
294 		hwwrite(vortex->mmio, 0x24368 + i * 0x24, coefs[i][0]);
295 		hwwrite(vortex->mmio, 0x2436c + i * 0x24, coefs[i][1]);
296 		hwwrite(vortex->mmio, 0x24370 + i * 0x24, coefs[i][2]);
297 		hwwrite(vortex->mmio, 0x24374 + i * 0x24, coefs[i][3]);
298 		hwwrite(vortex->mmio, 0x24378 + i * 0x24, coefs[i][4]);
299 	}
300 	hwwrite(vortex->mmio, 0x24548, arg_0 & 0xffff);
301 	hwwrite(vortex->mmio, 0x2454C, arg_4 & 0xffff);
302 }
303 
304 static void
vortex_XtalkHw_SetRightXT(vortex_t * vortex,short arg_0,short arg_4,xtalk_coefs_t const coefs)305 vortex_XtalkHw_SetRightXT(vortex_t * vortex, short arg_0, short arg_4,
306 			  xtalk_coefs_t const coefs)
307 {
308 	int i;
309 
310 	for (i = 0; i < 5; i++) {
311 		hwwrite(vortex->mmio, 0x2441C + i * 0x24, coefs[i][0]);
312 		hwwrite(vortex->mmio, 0x24420 + i * 0x24, coefs[i][1]);
313 		hwwrite(vortex->mmio, 0x24424 + i * 0x24, coefs[i][2]);
314 		hwwrite(vortex->mmio, 0x24428 + i * 0x24, coefs[i][3]);
315 		hwwrite(vortex->mmio, 0x2442C + i * 0x24, coefs[i][4]);
316 	}
317 	hwwrite(vortex->mmio, 0x24550, arg_0 & 0xffff);
318 	hwwrite(vortex->mmio, 0x24554, arg_4 & 0xffff);
319 }
320 
321 static void
vortex_XtalkHw_SetLeftEQStates(vortex_t * vortex,xtalk_instate_t const arg_0,xtalk_state_t const coefs)322 vortex_XtalkHw_SetLeftEQStates(vortex_t * vortex,
323 			       xtalk_instate_t const arg_0,
324 			       xtalk_state_t const coefs)
325 {
326 	int i;
327 
328 	for (i = 0; i < 5; i++) {
329 		hwwrite(vortex->mmio, 0x24214 + i * 0x24, coefs[i][0]);
330 		hwwrite(vortex->mmio, 0x24218 + i * 0x24, coefs[i][1]);
331 		hwwrite(vortex->mmio, 0x2421C + i * 0x24, coefs[i][2]);
332 		hwwrite(vortex->mmio, 0x24220 + i * 0x24, coefs[i][3]);
333 	}
334 	hwwrite(vortex->mmio, 0x244F8, arg_0[0]);
335 	hwwrite(vortex->mmio, 0x244FC, arg_0[1]);
336 	hwwrite(vortex->mmio, 0x24500, arg_0[2]);
337 	hwwrite(vortex->mmio, 0x24504, arg_0[3]);
338 }
339 
340 static void
vortex_XtalkHw_SetRightEQStates(vortex_t * vortex,xtalk_instate_t const arg_0,xtalk_state_t const coefs)341 vortex_XtalkHw_SetRightEQStates(vortex_t * vortex,
342 				xtalk_instate_t const arg_0,
343 				xtalk_state_t const coefs)
344 {
345 	int i;
346 
347 	for (i = 0; i < 5; i++) {
348 		hwwrite(vortex->mmio, 0x242C8 + i * 0x24, coefs[i][0]);
349 		hwwrite(vortex->mmio, 0x242CC + i * 0x24, coefs[i][1]);
350 		hwwrite(vortex->mmio, 0x242D0 + i * 0x24, coefs[i][2]);
351 		hwwrite(vortex->mmio, 0x244D4 + i * 0x24, coefs[i][3]);
352 	}
353 	hwwrite(vortex->mmio, 0x24508, arg_0[0]);
354 	hwwrite(vortex->mmio, 0x2450C, arg_0[1]);
355 	hwwrite(vortex->mmio, 0x24510, arg_0[2]);
356 	hwwrite(vortex->mmio, 0x24514, arg_0[3]);
357 }
358 
359 static void
vortex_XtalkHw_SetLeftXTStates(vortex_t * vortex,xtalk_instate_t const arg_0,xtalk_state_t const coefs)360 vortex_XtalkHw_SetLeftXTStates(vortex_t * vortex,
361 			       xtalk_instate_t const arg_0,
362 			       xtalk_state_t const coefs)
363 {
364 	int i;
365 
366 	for (i = 0; i < 5; i++) {
367 		hwwrite(vortex->mmio, 0x2437C + i * 0x24, coefs[i][0]);
368 		hwwrite(vortex->mmio, 0x24380 + i * 0x24, coefs[i][1]);
369 		hwwrite(vortex->mmio, 0x24384 + i * 0x24, coefs[i][2]);
370 		hwwrite(vortex->mmio, 0x24388 + i * 0x24, coefs[i][3]);
371 	}
372 	hwwrite(vortex->mmio, 0x24518, arg_0[0]);
373 	hwwrite(vortex->mmio, 0x2451C, arg_0[1]);
374 	hwwrite(vortex->mmio, 0x24520, arg_0[2]);
375 	hwwrite(vortex->mmio, 0x24524, arg_0[3]);
376 }
377 
378 static void
vortex_XtalkHw_SetRightXTStates(vortex_t * vortex,xtalk_instate_t const arg_0,xtalk_state_t const coefs)379 vortex_XtalkHw_SetRightXTStates(vortex_t * vortex,
380 				xtalk_instate_t const arg_0,
381 				xtalk_state_t const coefs)
382 {
383 	int i;
384 
385 	for (i = 0; i < 5; i++) {
386 		hwwrite(vortex->mmio, 0x24430 + i * 0x24, coefs[i][0]);
387 		hwwrite(vortex->mmio, 0x24434 + i * 0x24, coefs[i][1]);
388 		hwwrite(vortex->mmio, 0x24438 + i * 0x24, coefs[i][2]);
389 		hwwrite(vortex->mmio, 0x2443C + i * 0x24, coefs[i][3]);
390 	}
391 	hwwrite(vortex->mmio, 0x24528, arg_0[0]);
392 	hwwrite(vortex->mmio, 0x2452C, arg_0[1]);
393 	hwwrite(vortex->mmio, 0x24530, arg_0[2]);
394 	hwwrite(vortex->mmio, 0x24534, arg_0[3]);
395 }
396 
397 #if 0
398 static void
399 vortex_XtalkHw_GetLeftEQ(vortex_t * vortex, short *arg_0, short *arg_4,
400 			 xtalk_coefs_t coefs)
401 {
402 	int i;
403 
404 	for (i = 0; i < 5; i++) {
405 		coefs[i][0] = hwread(vortex->mmio, 0x24200 + i * 0x24);
406 		coefs[i][1] = hwread(vortex->mmio, 0x24204 + i * 0x24);
407 		coefs[i][2] = hwread(vortex->mmio, 0x24208 + i * 0x24);
408 		coefs[i][3] = hwread(vortex->mmio, 0x2420c + i * 0x24);
409 		coefs[i][4] = hwread(vortex->mmio, 0x24210 + i * 0x24);
410 	}
411 	*arg_0 = hwread(vortex->mmio, 0x24538) & 0xffff;
412 	*arg_4 = hwread(vortex->mmio, 0x2453c) & 0xffff;
413 }
414 
415 static void
416 vortex_XtalkHw_GetRightEQ(vortex_t * vortex, short *arg_0, short *arg_4,
417 			  xtalk_coefs_t coefs)
418 {
419 	int i;
420 
421 	for (i = 0; i < 5; i++) {
422 		coefs[i][0] = hwread(vortex->mmio, 0x242b4 + i * 0x24);
423 		coefs[i][1] = hwread(vortex->mmio, 0x242b8 + i * 0x24);
424 		coefs[i][2] = hwread(vortex->mmio, 0x242bc + i * 0x24);
425 		coefs[i][3] = hwread(vortex->mmio, 0x242c0 + i * 0x24);
426 		coefs[i][4] = hwread(vortex->mmio, 0x242c4 + i * 0x24);
427 	}
428 	*arg_0 = hwread(vortex->mmio, 0x24540) & 0xffff;
429 	*arg_4 = hwread(vortex->mmio, 0x24544) & 0xffff;
430 }
431 
432 static void
433 vortex_XtalkHw_GetLeftXT(vortex_t * vortex, short *arg_0, short *arg_4,
434 			 xtalk_coefs_t coefs)
435 {
436 	int i;
437 
438 	for (i = 0; i < 5; i++) {
439 		coefs[i][0] = hwread(vortex->mmio, 0x24368 + i * 0x24);
440 		coefs[i][1] = hwread(vortex->mmio, 0x2436C + i * 0x24);
441 		coefs[i][2] = hwread(vortex->mmio, 0x24370 + i * 0x24);
442 		coefs[i][3] = hwread(vortex->mmio, 0x24374 + i * 0x24);
443 		coefs[i][4] = hwread(vortex->mmio, 0x24378 + i * 0x24);
444 	}
445 	*arg_0 = hwread(vortex->mmio, 0x24548) & 0xffff;
446 	*arg_4 = hwread(vortex->mmio, 0x2454C) & 0xffff;
447 }
448 
449 static void
450 vortex_XtalkHw_GetRightXT(vortex_t * vortex, short *arg_0, short *arg_4,
451 			  xtalk_coefs_t coefs)
452 {
453 	int i;
454 
455 	for (i = 0; i < 5; i++) {
456 		coefs[i][0] = hwread(vortex->mmio, 0x2441C + i * 0x24);
457 		coefs[i][1] = hwread(vortex->mmio, 0x24420 + i * 0x24);
458 		coefs[i][2] = hwread(vortex->mmio, 0x24424 + i * 0x24);
459 		coefs[i][3] = hwread(vortex->mmio, 0x24428 + i * 0x24);
460 		coefs[i][4] = hwread(vortex->mmio, 0x2442C + i * 0x24);
461 	}
462 	*arg_0 = hwread(vortex->mmio, 0x24550) & 0xffff;
463 	*arg_4 = hwread(vortex->mmio, 0x24554) & 0xffff;
464 }
465 
466 static void
467 vortex_XtalkHw_GetLeftEQStates(vortex_t * vortex, xtalk_instate_t arg_0,
468 			       xtalk_state_t coefs)
469 {
470 	int i;
471 
472 	for (i = 0; i < 5; i++) {
473 		coefs[i][0] = hwread(vortex->mmio, 0x24214 + i * 0x24);
474 		coefs[i][1] = hwread(vortex->mmio, 0x24218 + i * 0x24);
475 		coefs[i][2] = hwread(vortex->mmio, 0x2421C + i * 0x24);
476 		coefs[i][3] = hwread(vortex->mmio, 0x24220 + i * 0x24);
477 	}
478 	arg_0[0] = hwread(vortex->mmio, 0x244F8);
479 	arg_0[1] = hwread(vortex->mmio, 0x244FC);
480 	arg_0[2] = hwread(vortex->mmio, 0x24500);
481 	arg_0[3] = hwread(vortex->mmio, 0x24504);
482 }
483 
484 static void
485 vortex_XtalkHw_GetRightEQStates(vortex_t * vortex, xtalk_instate_t arg_0,
486 				xtalk_state_t coefs)
487 {
488 	int i;
489 
490 	for (i = 0; i < 5; i++) {
491 		coefs[i][0] = hwread(vortex->mmio, 0x242C8 + i * 0x24);
492 		coefs[i][1] = hwread(vortex->mmio, 0x242CC + i * 0x24);
493 		coefs[i][2] = hwread(vortex->mmio, 0x242D0 + i * 0x24);
494 		coefs[i][3] = hwread(vortex->mmio, 0x242D4 + i * 0x24);
495 	}
496 	arg_0[0] = hwread(vortex->mmio, 0x24508);
497 	arg_0[1] = hwread(vortex->mmio, 0x2450C);
498 	arg_0[2] = hwread(vortex->mmio, 0x24510);
499 	arg_0[3] = hwread(vortex->mmio, 0x24514);
500 }
501 
502 static void
503 vortex_XtalkHw_GetLeftXTStates(vortex_t * vortex, xtalk_instate_t arg_0,
504 			       xtalk_state_t coefs)
505 {
506 	int i;
507 
508 	for (i = 0; i < 5; i++) {
509 		coefs[i][0] = hwread(vortex->mmio, 0x2437C + i * 0x24);
510 		coefs[i][1] = hwread(vortex->mmio, 0x24380 + i * 0x24);
511 		coefs[i][2] = hwread(vortex->mmio, 0x24384 + i * 0x24);
512 		coefs[i][3] = hwread(vortex->mmio, 0x24388 + i * 0x24);
513 	}
514 	arg_0[0] = hwread(vortex->mmio, 0x24518);
515 	arg_0[1] = hwread(vortex->mmio, 0x2451C);
516 	arg_0[2] = hwread(vortex->mmio, 0x24520);
517 	arg_0[3] = hwread(vortex->mmio, 0x24524);
518 }
519 
520 static void
521 vortex_XtalkHw_GetRightXTStates(vortex_t * vortex, xtalk_instate_t arg_0,
522 				xtalk_state_t coefs)
523 {
524 	int i;
525 
526 	for (i = 0; i < 5; i++) {
527 		coefs[i][0] = hwread(vortex->mmio, 0x24430 + i * 0x24);
528 		coefs[i][1] = hwread(vortex->mmio, 0x24434 + i * 0x24);
529 		coefs[i][2] = hwread(vortex->mmio, 0x24438 + i * 0x24);
530 		coefs[i][3] = hwread(vortex->mmio, 0x2443C + i * 0x24);
531 	}
532 	arg_0[0] = hwread(vortex->mmio, 0x24528);
533 	arg_0[1] = hwread(vortex->mmio, 0x2452C);
534 	arg_0[2] = hwread(vortex->mmio, 0x24530);
535 	arg_0[3] = hwread(vortex->mmio, 0x24534);
536 }
537 
538 #endif
539 /* Gains */
540 
541 static void
vortex_XtalkHw_SetGains(vortex_t * vortex,xtalk_gains_t const gains)542 vortex_XtalkHw_SetGains(vortex_t * vortex, xtalk_gains_t const gains)
543 {
544 	int i;
545 
546 	for (i = 0; i < XTGAINS_SZ; i++) {
547 		hwwrite(vortex->mmio, 0x244D0 + (i * 4), gains[i]);
548 	}
549 }
550 
551 static void
vortex_XtalkHw_SetGainsAllChan(vortex_t * vortex)552 vortex_XtalkHw_SetGainsAllChan(vortex_t * vortex)
553 {
554 	vortex_XtalkHw_SetGains(vortex, asXtalkGainsAllChan);
555 }
556 
557 #if 0
558 static void vortex_XtalkHw_GetGains(vortex_t * vortex, xtalk_gains_t gains)
559 {
560 	int i;
561 
562 	for (i = 0; i < XTGAINS_SZ; i++)
563 		gains[i] = hwread(vortex->mmio, 0x244D0 + i * 4);
564 }
565 
566 #endif
567 /* Delay parameters */
568 
569 static void
vortex_XtalkHw_SetDelay(vortex_t * vortex,unsigned short right,unsigned short left)570 vortex_XtalkHw_SetDelay(vortex_t * vortex, unsigned short right,
571 			unsigned short left)
572 {
573 	u32 esp0 = 0;
574 
575 	esp0 &= 0x1FFFFFFF;
576 	esp0 |= 0xA0000000;
577 	esp0 = (esp0 & 0xffffE0ff) | ((right & 0x1F) << 8);
578 	esp0 = (esp0 & 0xfffc1fff) | ((left & 0x1F) << 0xd);
579 
580 	hwwrite(vortex->mmio, 0x24660, esp0);
581 }
582 
583 static void
vortex_XtalkHw_SetLeftDline(vortex_t * vortex,xtalk_dline_t const dline)584 vortex_XtalkHw_SetLeftDline(vortex_t * vortex, xtalk_dline_t const dline)
585 {
586 	int i;
587 
588 	for (i = 0; i < 0x20; i++) {
589 		hwwrite(vortex->mmio, 0x24000 + (i << 2), dline[i] & 0xffff);
590 		hwwrite(vortex->mmio, 0x24080 + (i << 2), dline[i] >> 0x10);
591 	}
592 }
593 
594 static void
vortex_XtalkHw_SetRightDline(vortex_t * vortex,xtalk_dline_t const dline)595 vortex_XtalkHw_SetRightDline(vortex_t * vortex, xtalk_dline_t const dline)
596 {
597 	int i;
598 
599 	for (i = 0; i < 0x20; i++) {
600 		hwwrite(vortex->mmio, 0x24100 + (i << 2), dline[i] & 0xffff);
601 		hwwrite(vortex->mmio, 0x24180 + (i << 2), dline[i] >> 0x10);
602 	}
603 }
604 
605 #if 0
606 static void
607 vortex_XtalkHw_GetDelay(vortex_t * vortex, unsigned short *right,
608 			unsigned short *left)
609 {
610 	int esp0;
611 
612 	esp0 = hwread(vortex->mmio, 0x24660);
613 	*right = (esp0 >> 8) & 0x1f;
614 	*left = (esp0 >> 0xd) & 0x1f;
615 }
616 
617 static void vortex_XtalkHw_GetLeftDline(vortex_t * vortex, xtalk_dline_t dline)
618 {
619 	int i;
620 
621 	for (i = 0; i < 0x20; i++) {
622 		dline[i] =
623 		    (hwread(vortex->mmio, 0x24000 + (i << 2)) & 0xffff) |
624 		    (hwread(vortex->mmio, 0x24080 + (i << 2)) << 0x10);
625 	}
626 }
627 
628 static void vortex_XtalkHw_GetRightDline(vortex_t * vortex, xtalk_dline_t dline)
629 {
630 	int i;
631 
632 	for (i = 0; i < 0x20; i++) {
633 		dline[i] =
634 		    (hwread(vortex->mmio, 0x24100 + (i << 2)) & 0xffff) |
635 		    (hwread(vortex->mmio, 0x24180 + (i << 2)) << 0x10);
636 	}
637 }
638 
639 #endif
640 /* Control/Global stuff */
641 
642 #if 0
643 static void vortex_XtalkHw_SetControlReg(vortex_t * vortex, u32 ctrl)
644 {
645 	hwwrite(vortex->mmio, 0x24660, ctrl);
646 }
647 static void vortex_XtalkHw_GetControlReg(vortex_t * vortex, u32 *ctrl)
648 {
649 	*ctrl = hwread(vortex->mmio, 0x24660);
650 }
651 #endif
vortex_XtalkHw_SetSampleRate(vortex_t * vortex,u32 sr)652 static void vortex_XtalkHw_SetSampleRate(vortex_t * vortex, u32 sr)
653 {
654 	u32 temp;
655 
656 	temp = (hwread(vortex->mmio, 0x24660) & 0x1FFFFFFF) | 0xC0000000;
657 	temp = (temp & 0xffffff07) | ((sr & 0x1f) << 3);
658 	hwwrite(vortex->mmio, 0x24660, temp);
659 }
660 
661 #if 0
662 static void vortex_XtalkHw_GetSampleRate(vortex_t * vortex, u32 *sr)
663 {
664 	*sr = (hwread(vortex->mmio, 0x24660) >> 3) & 0x1f;
665 }
666 
667 #endif
vortex_XtalkHw_Enable(vortex_t * vortex)668 static void vortex_XtalkHw_Enable(vortex_t * vortex)
669 {
670 	u32 temp;
671 
672 	temp = (hwread(vortex->mmio, 0x24660) & 0x1FFFFFFF) | 0xC0000000;
673 	temp |= 1;
674 	hwwrite(vortex->mmio, 0x24660, temp);
675 
676 }
677 
vortex_XtalkHw_Disable(vortex_t * vortex)678 static void vortex_XtalkHw_Disable(vortex_t * vortex)
679 {
680 	u32 temp;
681 
682 	temp = (hwread(vortex->mmio, 0x24660) & 0x1FFFFFFF) | 0xC0000000;
683 	temp &= 0xfffffffe;
684 	hwwrite(vortex->mmio, 0x24660, temp);
685 
686 }
687 
vortex_XtalkHw_ZeroIO(vortex_t * vortex)688 static void vortex_XtalkHw_ZeroIO(vortex_t * vortex)
689 {
690 	int i;
691 
692 	for (i = 0; i < 20; i++)
693 		hwwrite(vortex->mmio, 0x24600 + (i << 2), 0);
694 	for (i = 0; i < 4; i++)
695 		hwwrite(vortex->mmio, 0x24650 + (i << 2), 0);
696 }
697 
vortex_XtalkHw_ZeroState(vortex_t * vortex)698 static void vortex_XtalkHw_ZeroState(vortex_t * vortex)
699 {
700 	vortex_XtalkHw_ZeroIO(vortex);	// inlined
701 
702 	vortex_XtalkHw_SetLeftEQ(vortex, 0, 0, asXtalkCoefsZeros);
703 	vortex_XtalkHw_SetRightEQ(vortex, 0, 0, asXtalkCoefsZeros);
704 
705 	vortex_XtalkHw_SetLeftXT(vortex, 0, 0, asXtalkCoefsZeros);
706 	vortex_XtalkHw_SetRightXT(vortex, 0, 0, asXtalkCoefsZeros);
707 
708 	vortex_XtalkHw_SetGains(vortex, asXtalkGainsZeros);	// inlined
709 
710 	vortex_XtalkHw_SetDelay(vortex, 0, 0);	// inlined
711 
712 	vortex_XtalkHw_SetLeftDline(vortex, alXtalkDlineZeros);	// inlined
713 	vortex_XtalkHw_SetRightDline(vortex, alXtalkDlineZeros);	// inlined
714 	vortex_XtalkHw_SetLeftDline(vortex, alXtalkDlineZeros);	// inlined
715 	vortex_XtalkHw_SetRightDline(vortex, alXtalkDlineZeros);	// inlined
716 
717 	vortex_XtalkHw_SetLeftEQStates(vortex, asXtalkInStateZeros,
718 				       asXtalkOutStateZeros);
719 	vortex_XtalkHw_SetRightEQStates(vortex, asXtalkInStateZeros,
720 					asXtalkOutStateZeros);
721 	vortex_XtalkHw_SetLeftXTStates(vortex, asXtalkInStateZeros,
722 				       asXtalkOutStateZeros);
723 	vortex_XtalkHw_SetRightXTStates(vortex, asXtalkInStateZeros,
724 					asXtalkOutStateZeros);
725 }
726 
vortex_XtalkHw_ProgramPipe(vortex_t * vortex)727 static void vortex_XtalkHw_ProgramPipe(vortex_t * vortex)
728 {
729 
730 	vortex_XtalkHw_SetLeftEQ(vortex, 0, 1, asXtalkCoefsPipe);
731 	vortex_XtalkHw_SetRightEQ(vortex, 0, 1, asXtalkCoefsPipe);
732 	vortex_XtalkHw_SetLeftXT(vortex, 0, 0, asXtalkCoefsZeros);
733 	vortex_XtalkHw_SetRightXT(vortex, 0, 0, asXtalkCoefsZeros);
734 
735 	vortex_XtalkHw_SetDelay(vortex, 0, 0);	// inlined
736 }
737 
vortex_XtalkHw_ProgramXtalkWide(vortex_t * vortex)738 static void vortex_XtalkHw_ProgramXtalkWide(vortex_t * vortex)
739 {
740 
741 	vortex_XtalkHw_SetLeftEQ(vortex, sXtalkWideKLeftEq,
742 				 sXtalkWideShiftLeftEq, asXtalkWideCoefsLeftEq);
743 	vortex_XtalkHw_SetRightEQ(vortex, sXtalkWideKRightEq,
744 				  sXtalkWideShiftRightEq,
745 				  asXtalkWideCoefsRightEq);
746 	vortex_XtalkHw_SetLeftXT(vortex, sXtalkWideKLeftXt,
747 				 sXtalkWideShiftLeftXt, asXtalkWideCoefsLeftXt);
748 	vortex_XtalkHw_SetRightXT(vortex, sXtalkWideKLeftXt,
749 				  sXtalkWideShiftLeftXt,
750 				  asXtalkWideCoefsLeftXt);
751 
752 	vortex_XtalkHw_SetDelay(vortex, wXtalkWideRightDelay, wXtalkWideLeftDelay);	// inlined
753 }
754 
vortex_XtalkHw_ProgramXtalkNarrow(vortex_t * vortex)755 static void vortex_XtalkHw_ProgramXtalkNarrow(vortex_t * vortex)
756 {
757 
758 	vortex_XtalkHw_SetLeftEQ(vortex, sXtalkNarrowKLeftEq,
759 				 sXtalkNarrowShiftLeftEq,
760 				 asXtalkNarrowCoefsLeftEq);
761 	vortex_XtalkHw_SetRightEQ(vortex, sXtalkNarrowKRightEq,
762 				  sXtalkNarrowShiftRightEq,
763 				  asXtalkNarrowCoefsRightEq);
764 	vortex_XtalkHw_SetLeftXT(vortex, sXtalkNarrowKLeftXt,
765 				 sXtalkNarrowShiftLeftXt,
766 				 asXtalkNarrowCoefsLeftXt);
767 	vortex_XtalkHw_SetRightXT(vortex, sXtalkNarrowKLeftXt,
768 				  sXtalkNarrowShiftLeftXt,
769 				  asXtalkNarrowCoefsLeftXt);
770 
771 	vortex_XtalkHw_SetDelay(vortex, wXtalkNarrowRightDelay, wXtalkNarrowLeftDelay);	// inlined
772 }
773 
vortex_XtalkHw_ProgramDiamondXtalk(vortex_t * vortex)774 static void vortex_XtalkHw_ProgramDiamondXtalk(vortex_t * vortex)
775 {
776 
777 	//sDiamondKLeftEq,sDiamondKRightXt,asDiamondCoefsLeftEq
778 	vortex_XtalkHw_SetLeftEQ(vortex, sDiamondKLeftEq,
779 				 sDiamondShiftLeftEq, asDiamondCoefsLeftEq);
780 	vortex_XtalkHw_SetRightEQ(vortex, sDiamondKRightEq,
781 				  sDiamondShiftRightEq, asDiamondCoefsRightEq);
782 	vortex_XtalkHw_SetLeftXT(vortex, sDiamondKLeftXt,
783 				 sDiamondShiftLeftXt, asDiamondCoefsLeftXt);
784 	vortex_XtalkHw_SetRightXT(vortex, sDiamondKLeftXt,
785 				  sDiamondShiftLeftXt, asDiamondCoefsLeftXt);
786 
787 	vortex_XtalkHw_SetDelay(vortex, wDiamondRightDelay, wDiamondLeftDelay);	// inlined
788 }
789 
vortex_XtalkHw_init(vortex_t * vortex)790 static void vortex_XtalkHw_init(vortex_t * vortex)
791 {
792 	vortex_XtalkHw_ZeroState(vortex);
793 }
794 
795 /* End of file */
796