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