^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /***************************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * au88x0_eq.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Aureal Vortex Hardware EQ control/access.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Sun Jun 8 18:19:19 2003
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * 2003 Manuel Jander (mjander@users.sourceforge.net)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * 02 July 2003: First time something works :)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * November 2003: A3D Bypass code completed but untested.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * TODO:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) * - Debug (testing)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * - Test peak visualization support.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) ****************************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) The Aureal Hardware EQ is found on AU8810 and AU8830 chips only.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) it has 4 inputs (2 for general mix, 2 for A3D) and 2 outputs (supposed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) to be routed to the codec).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include "au88x0.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include "au88x0_eq.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include "au88x0_eqdata.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define VORTEX_EQ_BASE 0x2b000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define VORTEX_EQ_DEST (VORTEX_EQ_BASE + 0x410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define VORTEX_EQ_SOURCE (VORTEX_EQ_BASE + 0x430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define VORTEX_EQ_CTRL (VORTEX_EQ_BASE + 0x440)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define VORTEX_BAND_COEFF_SIZE 0x30
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) /* CEqHw.s */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) static void vortex_EqHw_SetTimeConsts(vortex_t * vortex, u16 gain, u16 level)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) hwwrite(vortex->mmio, 0x2b3c4, gain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) hwwrite(vortex->mmio, 0x2b3c8, level);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) static inline u16 sign_invert(u16 a)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) /* -(-32768) -> -32768 so we do -(-32768) -> 32767 to make the result positive */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) if (a == (u16)-32768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) return 32767;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) return -a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static void vortex_EqHw_SetLeftCoefs(vortex_t *vortex, const u16 coefs[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) int i = 0, n /*esp2c */;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) for (n = 0; n < eqhw->this04; n++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) hwwrite(vortex->mmio, 0x2b000 + n * 0x30, coefs[i + 0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) hwwrite(vortex->mmio, 0x2b004 + n * 0x30, coefs[i + 1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) if (eqhw->this08 == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) hwwrite(vortex->mmio, 0x2b008 + n * 0x30, coefs[i + 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) hwwrite(vortex->mmio, 0x2b00c + n * 0x30, coefs[i + 3]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) hwwrite(vortex->mmio, 0x2b010 + n * 0x30, coefs[i + 4]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) hwwrite(vortex->mmio, 0x2b008 + n * 0x30, sign_invert(coefs[2 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) hwwrite(vortex->mmio, 0x2b00c + n * 0x30, sign_invert(coefs[3 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) hwwrite(vortex->mmio, 0x2b010 + n * 0x30, sign_invert(coefs[4 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) i += 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) static void vortex_EqHw_SetRightCoefs(vortex_t *vortex, const u16 coefs[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) int i = 0, n /*esp2c */;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) for (n = 0; n < eqhw->this04; n++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) hwwrite(vortex->mmio, 0x2b1e0 + n * 0x30, coefs[0 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) hwwrite(vortex->mmio, 0x2b1e4 + n * 0x30, coefs[1 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) if (eqhw->this08 == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) hwwrite(vortex->mmio, 0x2b1e8 + n * 0x30, coefs[2 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) hwwrite(vortex->mmio, 0x2b1ec + n * 0x30, coefs[3 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) hwwrite(vortex->mmio, 0x2b1f0 + n * 0x30, coefs[4 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) hwwrite(vortex->mmio, 0x2b1e8 + n * 0x30, sign_invert(coefs[2 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) hwwrite(vortex->mmio, 0x2b1ec + n * 0x30, sign_invert(coefs[3 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) hwwrite(vortex->mmio, 0x2b1f0 + n * 0x30, sign_invert(coefs[4 + i]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) i += 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) static void vortex_EqHw_SetLeftStates(vortex_t *vortex, const u16 a[], const u16 b[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) int i = 0, ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) hwwrite(vortex->mmio, 0x2b3fc, a[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) hwwrite(vortex->mmio, 0x2b400, a[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) hwwrite(vortex->mmio, 0x2b014 + (i * 0xc), b[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) hwwrite(vortex->mmio, 0x2b018 + (i * 0xc), b[1 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) hwwrite(vortex->mmio, 0x2b01c + (i * 0xc), b[2 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) hwwrite(vortex->mmio, 0x2b020 + (i * 0xc), b[3 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) i += 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static void vortex_EqHw_SetRightStates(vortex_t *vortex, const u16 a[], const u16 b[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) int i = 0, ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) hwwrite(vortex->mmio, 0x2b404, a[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) hwwrite(vortex->mmio, 0x2b408, a[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) hwwrite(vortex->mmio, 0x2b1f4 + (i * 0xc), b[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) hwwrite(vortex->mmio, 0x2b1f8 + (i * 0xc), b[1 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) hwwrite(vortex->mmio, 0x2b1fc + (i * 0xc), b[2 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) hwwrite(vortex->mmio, 0x2b200 + (i * 0xc), b[3 + i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) i += 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) static void vortex_EqHw_GetTimeConsts(vortex_t * vortex, u16 * a, u16 * b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) *a = hwread(vortex->mmio, 0x2b3c4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) *b = hwread(vortex->mmio, 0x2b3c8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static void vortex_EqHw_GetLeftCoefs(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) static void vortex_EqHw_GetRightCoefs(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) static void vortex_EqHw_GetLeftStates(vortex_t * vortex, u16 * a, u16 b[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) static void vortex_EqHw_GetRightStates(vortex_t * vortex, u16 * a, u16 b[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) /* Mix Gains */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) static void vortex_EqHw_SetBypassGain(vortex_t * vortex, u16 a, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) if (eqhw->this08 == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) hwwrite(vortex->mmio, 0x2b3d4, a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) hwwrite(vortex->mmio, 0x2b3ec, b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) hwwrite(vortex->mmio, 0x2b3d4, sign_invert(a));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) hwwrite(vortex->mmio, 0x2b3ec, sign_invert(b));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) static void vortex_EqHw_SetA3DBypassGain(vortex_t * vortex, u16 a, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) hwwrite(vortex->mmio, 0x2b3e0, a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) hwwrite(vortex->mmio, 0x2b3f8, b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) static void vortex_EqHw_SetCurrBypassGain(vortex_t * vortex, u16 a, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) hwwrite(vortex->mmio, 0x2b3d0, a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) hwwrite(vortex->mmio, 0x2b3e8, b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) static void vortex_EqHw_SetCurrA3DBypassGain(vortex_t * vortex, u16 a, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) hwwrite(vortex->mmio, 0x2b3dc, a);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) hwwrite(vortex->mmio, 0x2b3f4, b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) vortex_EqHw_SetLeftGainsSingleTarget(vortex_t * vortex, u16 index, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) hwwrite(vortex->mmio, 0x2b02c + (index * 0x30), b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) vortex_EqHw_SetRightGainsSingleTarget(vortex_t * vortex, u16 index, u16 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) hwwrite(vortex->mmio, 0x2b20c + (index * 0x30), b);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) static void vortex_EqHw_SetLeftGainsTarget(vortex_t *vortex, const u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) int ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) hwwrite(vortex->mmio, 0x2b02c + ebx * 0x30, a[ebx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) static void vortex_EqHw_SetRightGainsTarget(vortex_t *vortex, const u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) int ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) hwwrite(vortex->mmio, 0x2b20c + ebx * 0x30, a[ebx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) static void vortex_EqHw_SetLeftGainsCurrent(vortex_t *vortex, const u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) int ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) hwwrite(vortex->mmio, 0x2b028 + ebx * 0x30, a[ebx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) static void vortex_EqHw_SetRightGainsCurrent(vortex_t *vortex, const u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) int ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) for (ebx = 0; ebx < eqhw->this04; ebx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) hwwrite(vortex->mmio, 0x2b208 + ebx * 0x30, a[ebx]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) static void vortex_EqHw_GetLeftGainsTarget(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) int ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) if (eqhw->this04 < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) a[ebx] = hwread(vortex->mmio, 0x2b02c + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) static void vortex_EqHw_GetRightGainsTarget(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) int ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) if (eqhw->this04 < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) a[ebx] = hwread(vortex->mmio, 0x2b20c + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) static void vortex_EqHw_GetLeftGainsCurrent(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) int ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) if (eqhw->this04 < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) a[ebx] = hwread(vortex->mmio, 0x2b028 + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) static void vortex_EqHw_GetRightGainsCurrent(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) int ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (eqhw->this04 < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) a[ebx] = hwread(vortex->mmio, 0x2b208 + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) /* EQ band levels settings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) static void vortex_EqHw_SetLevels(vortex_t *vortex, const u16 peaks[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) /* set left peaks */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) for (i = 0; i < eqhw->this04; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) hwwrite(vortex->mmio, 0x2b024 + i * VORTEX_BAND_COEFF_SIZE, peaks[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) hwwrite(vortex->mmio, 0x2b3cc, peaks[eqhw->this04]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) hwwrite(vortex->mmio, 0x2b3d8, peaks[eqhw->this04 + 1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) /* set right peaks */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) for (i = 0; i < eqhw->this04; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) hwwrite(vortex->mmio, 0x2b204 + i * VORTEX_BAND_COEFF_SIZE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) peaks[i + (eqhw->this04 + 2)]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) hwwrite(vortex->mmio, 0x2b3e4, peaks[2 + (eqhw->this04 * 2)]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) hwwrite(vortex->mmio, 0x2b3f0, peaks[3 + (eqhw->this04 * 2)]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) static void vortex_EqHw_GetLevels(vortex_t * vortex, u16 a[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) int ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (eqhw->this04 < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) a[ebx] = hwread(vortex->mmio, 0x2b024 + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) a[eqhw->this04] = hwread(vortex->mmio, 0x2b3cc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) a[eqhw->this04 + 1] = hwread(vortex->mmio, 0x2b3d8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) ebx = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) a[ebx + (eqhw->this04 + 2)] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) hwread(vortex->mmio, 0x2b204 + ebx * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) ebx++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) while (ebx < eqhw->this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) a[2 + (eqhw->this04 * 2)] = hwread(vortex->mmio, 0x2b3e4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) a[3 + (eqhw->this04 * 2)] = hwread(vortex->mmio, 0x2b3f0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) /* Global Control */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) static void vortex_EqHw_SetControlReg(vortex_t * vortex, u32 reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) hwwrite(vortex->mmio, 0x2b440, reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) static void vortex_EqHw_SetSampleRate(vortex_t * vortex, u32 sr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) hwwrite(vortex->mmio, 0x2b440, ((sr & 0x1f) << 3) | 0xb800);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) static void vortex_EqHw_GetControlReg(vortex_t * vortex, u32 *reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) *reg = hwread(vortex->mmio, 0x2b440);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) static void vortex_EqHw_GetSampleRate(vortex_t * vortex, u32 *sr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) *sr = (hwread(vortex->mmio, 0x2b440) >> 3) & 0x1f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) static void vortex_EqHw_Enable(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) hwwrite(vortex->mmio, VORTEX_EQ_CTRL, 0xf001);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) static void vortex_EqHw_Disable(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) hwwrite(vortex->mmio, VORTEX_EQ_CTRL, 0xf000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) /* Reset (zero) buffers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) static void vortex_EqHw_ZeroIO(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) for (i = 0; i < 0x8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) hwwrite(vortex->mmio, VORTEX_EQ_DEST + (i << 2), 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) for (i = 0; i < 0x4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) hwwrite(vortex->mmio, VORTEX_EQ_SOURCE + (i << 2), 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) static void vortex_EqHw_ZeroA3DIO(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) for (i = 0; i < 0x4; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) hwwrite(vortex->mmio, VORTEX_EQ_DEST + (i << 2), 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) static void vortex_EqHw_ZeroState(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) vortex_EqHw_SetControlReg(vortex, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) vortex_EqHw_ZeroIO(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) hwwrite(vortex->mmio, 0x2b3c0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) vortex_EqHw_SetTimeConsts(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) vortex_EqHw_SetLeftCoefs(vortex, asEqCoefsZeros);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) vortex_EqHw_SetRightCoefs(vortex, asEqCoefsZeros);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) vortex_EqHw_SetLeftGainsCurrent(vortex, eq_gains_zero);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) vortex_EqHw_SetRightGainsCurrent(vortex, eq_gains_zero);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) vortex_EqHw_SetLeftGainsTarget(vortex, eq_gains_zero);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) vortex_EqHw_SetRightGainsTarget(vortex, eq_gains_zero);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) vortex_EqHw_SetBypassGain(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) //vortex_EqHw_SetCurrBypassGain(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) vortex_EqHw_SetA3DBypassGain(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) //vortex_EqHw_SetCurrA3DBypassGain(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) vortex_EqHw_SetLeftStates(vortex, eq_states_zero, asEqOutStateZeros);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) vortex_EqHw_SetRightStates(vortex, eq_states_zero, asEqOutStateZeros);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) vortex_EqHw_SetLevels(vortex, (u16 *) eq_levels);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) /* Program coeficients as pass through */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) static void vortex_EqHw_ProgramPipe(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) vortex_EqHw_SetTimeConsts(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) vortex_EqHw_SetLeftCoefs(vortex, asEqCoefsPipes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) vortex_EqHw_SetRightCoefs(vortex, asEqCoefsPipes);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) vortex_EqHw_SetLeftGainsCurrent(vortex, eq_gains_current);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) vortex_EqHw_SetRightGainsCurrent(vortex, eq_gains_current);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) vortex_EqHw_SetLeftGainsTarget(vortex, eq_gains_current);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) vortex_EqHw_SetRightGainsTarget(vortex, eq_gains_current);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) /* Program EQ block as 10 band Equalizer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) vortex_EqHw_Program10Band(vortex_t * vortex, auxxEqCoeffSet_t * coefset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) vortex_EqHw_SetTimeConsts(vortex, 0xc, 0x7fe0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) vortex_EqHw_SetLeftCoefs(vortex, coefset->LeftCoefs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) vortex_EqHw_SetRightCoefs(vortex, coefset->RightCoefs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) vortex_EqHw_SetLeftGainsCurrent(vortex, coefset->LeftGains);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) vortex_EqHw_SetRightGainsTarget(vortex, coefset->RightGains);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) vortex_EqHw_SetLeftGainsTarget(vortex, coefset->LeftGains);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) vortex_EqHw_SetRightGainsCurrent(vortex, coefset->RightGains);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) /* Read all EQ peaks. (think VU meter) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) static void vortex_EqHw_GetTenBandLevels(vortex_t * vortex, u16 peaks[])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) eqhw_t *eqhw = &(vortex->eq.this04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) if (eqhw->this04 <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) for (i = 0; i < eqhw->this04; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) peaks[i] = hwread(vortex->mmio, 0x2B024 + i * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) for (i = 0; i < eqhw->this04; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) peaks[i + eqhw->this04] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) hwread(vortex->mmio, 0x2B204 + i * 0x30);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) /* CEqlzr.s */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) static int vortex_Eqlzr_GetLeftGain(vortex_t * vortex, u16 index, u16 * gain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) if (eq->this28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) *gain = eq->this130[index];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) static void vortex_Eqlzr_SetLeftGain(vortex_t * vortex, u16 index, u16 gain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) if (eq->this28 == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) eq->this130[index] = gain;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) if (eq->this54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) vortex_EqHw_SetLeftGainsSingleTarget(vortex, index, gain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) static int vortex_Eqlzr_GetRightGain(vortex_t * vortex, u16 index, u16 * gain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (eq->this28) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) *gain = eq->this130[index + eq->this10];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) static void vortex_Eqlzr_SetRightGain(vortex_t * vortex, u16 index, u16 gain)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) if (eq->this28 == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) eq->this130[index + eq->this10] = gain;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) if (eq->this54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) vortex_EqHw_SetRightGainsSingleTarget(vortex, index, gain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) vortex_Eqlzr_GetAllBands(vortex_t * vortex, u16 * gains, s32 *cnt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) int si = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) if (eq->this10 == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) if (vortex_Eqlzr_GetLeftGain(vortex, si, &gains[si]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) if (vortex_Eqlzr_GetRightGain
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) (vortex, si, &gains[si + eq->this10]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) si++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) while (eq->this10 > si) ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) *cnt = si * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) static int vortex_Eqlzr_SetAllBandsFromActiveCoeffSet(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) vortex_EqHw_SetLeftGainsTarget(vortex, eq->this130);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) vortex_EqHw_SetRightGainsTarget(vortex, &(eq->this130[eq->this10]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) vortex_Eqlzr_SetAllBands(vortex_t *vortex, const u16 gains[], s32 count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) if (((eq->this10) * 2 != count) || (eq->this28 == 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) for (i = 0; i < count; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) eq->this130[i] = gains[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) if (eq->this54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) return vortex_Eqlzr_SetAllBandsFromActiveCoeffSet(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) static void
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) vortex_Eqlzr_SetA3dBypassGain(vortex_t * vortex, u32 a, u32 b)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) u32 eax, ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) eq->this58 = a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) eq->this5c = b;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) if (eq->this54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) eax = eq->this0e;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) eax = eq->this0a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) ebx = (eax * eq->this58) >> 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) eax = (eax * eq->this5c) >> 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) vortex_EqHw_SetA3DBypassGain(vortex, ebx, eax);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) static void vortex_Eqlzr_ProgramA3dBypassGain(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) u32 eax, ebx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) if (eq->this54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) eax = eq->this0e;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) eax = eq->this0a;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) ebx = (eax * eq->this58) >> 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) eax = (eax * eq->this5c) >> 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) vortex_EqHw_SetA3DBypassGain(vortex, ebx, eax);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) static void vortex_Eqlzr_ShutDownA3d(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) if (vortex != NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) vortex_EqHw_ZeroA3DIO(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) static void vortex_Eqlzr_SetBypass(vortex_t * vortex, u32 bp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) if ((eq->this28) && (bp == 0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) /* EQ enabled */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) vortex_Eqlzr_SetAllBandsFromActiveCoeffSet(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) vortex_EqHw_SetBypassGain(vortex, eq->this08, eq->this08);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) /* EQ disabled. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) vortex_EqHw_SetLeftGainsTarget(vortex, eq->this14_array);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) vortex_EqHw_SetRightGainsTarget(vortex, eq->this14_array);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) vortex_EqHw_SetBypassGain(vortex, eq->this0c, eq->this0c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) vortex_Eqlzr_ProgramA3dBypassGain(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) static void vortex_Eqlzr_ReadAndSetActiveCoefSet(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) /* Set EQ BiQuad filter coeficients */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) memcpy(&(eq->coefset), &asEqCoefsNormal, sizeof(auxxEqCoeffSet_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) /* Set EQ Band gain levels and dump into hardware registers. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) vortex_Eqlzr_SetAllBands(vortex, eq_gains_normal, eq->this10 * 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) static int vortex_Eqlzr_GetAllPeaks(vortex_t * vortex, u16 * peaks, int *count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) if (eq->this10 == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) *count = eq->this10 * 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) vortex_EqHw_GetTenBandLevels(vortex, peaks);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) #if 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) static auxxEqCoeffSet_t *vortex_Eqlzr_GetActiveCoefSet(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) return (&(eq->coefset));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) static void vortex_Eqlzr_init(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) /* Object constructor */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) //eq->this04 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) eq->this08 = 0; /* Bypass gain with EQ in use. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) eq->this0a = 0x5999;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) eq->this0c = 0x5999; /* Bypass gain with EQ disabled. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) eq->this0e = 0x5999;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) eq->this10 = 0xa; /* 10 eq frequency bands. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) eq->this04.this04 = eq->this10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) eq->this28 = 0x1; /* if 1 => Allow read access to this130 (gains) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) eq->this54 = 0x0; /* if 1 => Dont Allow access to hardware (gains) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) eq->this58 = 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) eq->this5c = 0xffff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) /* Set gains. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) memset(eq->this14_array, 0, sizeof(eq->this14_array));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) /* Actual init. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) vortex_EqHw_ZeroState(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) vortex_EqHw_SetSampleRate(vortex, 0x11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) vortex_Eqlzr_ReadAndSetActiveCoefSet(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) vortex_EqHw_Program10Band(vortex, &(eq->coefset));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) vortex_Eqlzr_SetBypass(vortex, eq->this54);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) vortex_Eqlzr_SetA3dBypassGain(vortex, 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) vortex_EqHw_Enable(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) static void vortex_Eqlzr_shutdown(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) vortex_Eqlzr_ShutDownA3d(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) vortex_EqHw_ProgramPipe(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) vortex_EqHw_Disable(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) /* ALSA interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) /* Control interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) #define snd_vortex_eqtoggle_info snd_ctl_boolean_mono_info
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) snd_vortex_eqtoggle_get(struct snd_kcontrol *kcontrol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) struct snd_ctl_elem_value *ucontrol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) vortex_t *vortex = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) //int i = kcontrol->private_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) ucontrol->value.integer.value[0] = eq->this54 ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) snd_vortex_eqtoggle_put(struct snd_kcontrol *kcontrol,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) struct snd_ctl_elem_value *ucontrol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) vortex_t *vortex = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) eqlzr_t *eq = &(vortex->eq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) //int i = kcontrol->private_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) eq->this54 = ucontrol->value.integer.value[0] ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) vortex_Eqlzr_SetBypass(vortex, eq->this54);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) return 1; /* Allways changes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) static const struct snd_kcontrol_new vortex_eqtoggle_kcontrol = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) .name = "EQ Enable",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) .index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) .private_value = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) .info = snd_vortex_eqtoggle_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) .get = snd_vortex_eqtoggle_get,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) .put = snd_vortex_eqtoggle_put
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) snd_vortex_eq_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) uinfo->count = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) uinfo->value.integer.min = 0x0000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) uinfo->value.integer.max = 0x7fff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) snd_vortex_eq_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) vortex_t *vortex = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) int i = kcontrol->private_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) u16 gainL = 0, gainR = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) vortex_Eqlzr_GetLeftGain(vortex, i, &gainL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) vortex_Eqlzr_GetRightGain(vortex, i, &gainR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) ucontrol->value.integer.value[0] = gainL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) ucontrol->value.integer.value[1] = gainR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) snd_vortex_eq_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) vortex_t *vortex = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) int changed = 0, i = kcontrol->private_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) u16 gainL = 0, gainR = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) vortex_Eqlzr_GetLeftGain(vortex, i, &gainL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) vortex_Eqlzr_GetRightGain(vortex, i, &gainR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) if (gainL != ucontrol->value.integer.value[0]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) vortex_Eqlzr_SetLeftGain(vortex, i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) ucontrol->value.integer.value[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) changed = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) if (gainR != ucontrol->value.integer.value[1]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) vortex_Eqlzr_SetRightGain(vortex, i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) ucontrol->value.integer.value[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) changed = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) return changed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) static const struct snd_kcontrol_new vortex_eq_kcontrol = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) .name = " .",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) .index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) .private_value = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) .info = snd_vortex_eq_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) .get = snd_vortex_eq_get,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) .put = snd_vortex_eq_put
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) snd_vortex_peaks_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) uinfo->count = 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) uinfo->value.integer.min = 0x0000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) uinfo->value.integer.max = 0x7fff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) static int
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) snd_vortex_peaks_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) vortex_t *vortex = snd_kcontrol_chip(kcontrol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) int i, count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) u16 peaks[20];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) vortex_Eqlzr_GetAllPeaks(vortex, peaks, &count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) if (count != 20) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) dev_err(vortex->card->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) "peak count error 20 != %d\n", count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) for (i = 0; i < 20; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) ucontrol->value.integer.value[i] = peaks[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) static const struct snd_kcontrol_new vortex_levels_kcontrol = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) .name = "EQ Peaks",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) .access = SNDRV_CTL_ELEM_ACCESS_READ | SNDRV_CTL_ELEM_ACCESS_VOLATILE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) .info = snd_vortex_peaks_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) .get = snd_vortex_peaks_get,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) /* EQ band gain labels. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) static const char * const EqBandLabels[10] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) "EQ0 31Hz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) "EQ1 63Hz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) "EQ2 125Hz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) "EQ3 250Hz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) "EQ4 500Hz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) "EQ5 1KHz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) "EQ6 2KHz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) "EQ7 4KHz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) "EQ8 8KHz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) "EQ9 16KHz\0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) /* ALSA driver entry points. Init and exit. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) static int vortex_eq_init(vortex_t *vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) struct snd_kcontrol *kcontrol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) vortex_Eqlzr_init(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) if ((kcontrol =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) snd_ctl_new1(&vortex_eqtoggle_kcontrol, vortex)) == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) kcontrol->private_value = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) if ((err = snd_ctl_add(vortex->card, kcontrol)) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) /* EQ gain controls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) for (i = 0; i < 10; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) if ((kcontrol =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) snd_ctl_new1(&vortex_eq_kcontrol, vortex)) == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) snprintf(kcontrol->id.name, sizeof(kcontrol->id.name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) "%s Playback Volume", EqBandLabels[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) kcontrol->private_value = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) if ((err = snd_ctl_add(vortex->card, kcontrol)) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) //vortex->eqctrl[i] = kcontrol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) /* EQ band levels */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) if ((kcontrol = snd_ctl_new1(&vortex_levels_kcontrol, vortex)) == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) if ((err = snd_ctl_add(vortex->card, kcontrol)) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) static int vortex_eq_free(vortex_t * vortex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) //FIXME: segfault because vortex->eqctrl[i] == 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) for (i=0; i<10; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) if (vortex->eqctrl[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911) snd_ctl_remove(vortex->card, vortex->eqctrl[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) vortex_Eqlzr_shutdown(vortex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) /* End */
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags