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