Thomas Gleixner | 005fdd5 | 2019-05-24 12:03:50 +0200 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 20 | static __maybe_unused short const sXtalkWideKRightXt = 0xF25E; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | static short const sXtalkWideShiftLeftEq = 1; |
| 22 | static short const sXtalkWideShiftRightEq = 1; |
| 23 | static short const sXtalkWideShiftLeftXt = 0; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 24 | static __maybe_unused short const sXtalkWideShiftRightXt = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 30 | static __maybe_unused short const sXtalkNarrowKRightXt = 0xF82E; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | static short const sXtalkNarrowShiftLeftEq = 0x3; |
| 32 | static short const sXtalkNarrowShiftRightEq = 0x3; |
| 33 | static short const sXtalkNarrowShiftLeftXt = 0; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 34 | static __maybe_unused short const sXtalkNarrowShiftRightXt = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | static unsigned short const wXtalkNarrowLeftDelay = 0x7; |
| 36 | static unsigned short const wXtalkNarrowRightDelay = 0x7; |
| 37 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 38 | static __maybe_unused xtalk_gains_t const asXtalkGainsDefault = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 39 | 0x4000, 0x4000, 0x4000, 0x4000, 0x4000, |
| 40 | 0x4000, 0x4000, 0x4000, 0x4000, 0x4000 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | }; |
| 42 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 43 | static __maybe_unused xtalk_gains_t const asXtalkGainsTest = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 44 | 0x7fff, 0x8000, 0x0000, 0x0000, 0x0001, |
| 45 | 0xffff, 0x4000, 0xc000, 0x0002, 0xfffe |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | }; |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 47 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 48 | static __maybe_unused xtalk_gains_t const asXtalkGains1Chan = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 49 | 0x7FFF, 0, 0, 0, 0, |
| 50 | 0x7FFF, 0, 0, 0, 0, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | }; |
| 52 | |
| 53 | // Input gain for 4 A3D slices. One possible input pair is left zero. |
| 54 | static xtalk_gains_t const asXtalkGainsAllChan = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 55 | 0x7FFF, 0x7FFF, 0x7FFF, 0x7FFF, 0, |
| 56 | 0x7FFF, 0x7FFF, 0x7FFF, 0x7FFF, 0 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 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 | }; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 67 | static __maybe_unused xtalk_dline_t const alXtalkDlineTest = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 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 = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 | 0, 0, 0, 0 |
| 75 | }; |
| 76 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 77 | static __maybe_unused xtalk_instate_t const asXtalkInStateTest = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 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 | }; |
Takashi Iwai | 6581f4e | 2006-05-17 17:14:51 +0200 | [diff] [blame] | 88 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | static short const sDiamondKLeftEq = 0x401d; |
| 90 | static short const sDiamondKRightEq = 0x401d; |
| 91 | static short const sDiamondKLeftXt = 0xF90E; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 92 | static __maybe_unused short const sDiamondKRightXt = 0xF90E; |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 93 | static short const sDiamondShiftLeftEq = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | static short const sDiamondShiftRightEq = 1; |
| 95 | static short const sDiamondShiftLeftXt = 0; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 96 | static __maybe_unused short const sDiamondShiftRightXt = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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}, |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 103 | {0x340B, 0xe8f5, 0x236c, 0xe40d, 0}, |
| 104 | {0x76d5, 0xc78d, 0x05ac, 0xfa5b, 0}, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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}, |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 110 | {0x340B, 0xe8f5, 0x236c, 0xe40d, 0}, |
| 111 | {0x76d5, 0xc78d, 0x05ac, 0xfa5b, 0}, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | {0x7F04, 0xC0FA, 0x0263, 0xFDA2, 0} |
| 113 | }; |
| 114 | static xtalk_coefs_t const asXtalkWideCoefsLeftXt = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 115 | {0x55c6, 0xc97b, 0x005b, 0x0047, 0}, |
| 116 | {0x6a60, 0xca20, 0xffc6, 0x0040, 0}, |
| 117 | {0x6411, 0xd711, 0xfca1, 0x0190, 0}, |
| 118 | {0x77dc, 0xc79e, 0xffb8, 0x000a, 0}, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | {0, 0, 0, 0, 0} |
| 120 | }; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 121 | static __maybe_unused xtalk_coefs_t const asXtalkWideCoefsRightXt = { |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 122 | {0x55c6, 0xc97b, 0x005b, 0x0047, 0}, |
| 123 | {0x6a60, 0xca20, 0xffc6, 0x0040, 0}, |
| 124 | {0x6411, 0xd711, 0xfca1, 0x0190, 0}, |
| 125 | {0x77dc, 0xc79e, 0xffb8, 0x000a, 0}, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 152 | static __maybe_unused xtalk_coefs_t const asXtalkNarrowCoefsRightXt = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 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 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | }; |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 175 | static __maybe_unused xtalk_coefs_t const asXtalkCoefsNegPipe = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 183 | static __maybe_unused xtalk_coefs_t const asXtalkCoefsNumTest = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 191 | static __maybe_unused xtalk_coefs_t const asXtalkCoefsDenTest = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 199 | static __maybe_unused xtalk_state_t const asXtalkOutStateTest = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | {0x7FFF, 0x0004, 0xFFFC, 0}, |
| 201 | {0xFE00, 0x0008, 0xFFF8, 0x4000}, |
Raymond Yau | 76474da | 2012-01-04 16:16:26 +0800 | [diff] [blame] | 202 | {0x0200, 0x0010, 0xFFF0, 0xC000}, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | |
Pierre-Louis Bossart | ad1e0b7 | 2020-07-02 14:36:04 -0500 | [diff] [blame] | 231 | static __maybe_unused xtalk_coefs_t const asDiamondCoefsRightXt = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
| 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 |
| 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 |
| 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 |
| 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 |
| 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 326 | } |
| 327 | |
| 328 | static void |
| 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 345 | } |
| 346 | |
| 347 | static void |
| 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | } |
| 365 | |
| 366 | static void |
| 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 | } |
Raymond Yau | 9489f2c | 2012-01-04 15:42:44 +0800 | [diff] [blame] | 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); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | } |
| 525 | |
| 526 | #endif |
| 527 | /* Gains */ |
| 528 | |
| 529 | static void |
| 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 |
| 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 |
| 558 | vortex_XtalkHw_SetDelay(vortex_t * vortex, unsigned short right, |
| 559 | unsigned short left) |
| 560 | { |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 561 | u32 esp0 = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
| 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 |
| 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 |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 631 | static void vortex_XtalkHw_SetControlReg(vortex_t * vortex, u32 ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 632 | { |
| 633 | hwwrite(vortex->mmio, 0x24660, ctrl); |
| 634 | } |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 635 | static void vortex_XtalkHw_GetControlReg(vortex_t * vortex, u32 *ctrl) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 636 | { |
| 637 | *ctrl = hwread(vortex->mmio, 0x24660); |
| 638 | } |
| 639 | #endif |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 640 | static void vortex_XtalkHw_SetSampleRate(vortex_t * vortex, u32 sr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 641 | { |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 642 | u32 temp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 650 | static void vortex_XtalkHw_GetSampleRate(vortex_t * vortex, u32 *sr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | { |
| 652 | *sr = (hwread(vortex->mmio, 0x24660) >> 3) & 0x1f; |
| 653 | } |
| 654 | |
| 655 | #endif |
| 656 | static void vortex_XtalkHw_Enable(vortex_t * vortex) |
| 657 | { |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 658 | u32 temp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 659 | |
| 660 | temp = (hwread(vortex->mmio, 0x24660) & 0x1FFFFFFF) | 0xC0000000; |
| 661 | temp |= 1; |
| 662 | hwwrite(vortex->mmio, 0x24660, temp); |
| 663 | |
| 664 | } |
| 665 | |
| 666 | static void vortex_XtalkHw_Disable(vortex_t * vortex) |
| 667 | { |
Takashi Iwai | 97c67b6 | 2006-01-13 17:16:29 +0100 | [diff] [blame] | 668 | u32 temp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 669 | |
| 670 | temp = (hwread(vortex->mmio, 0x24660) & 0x1FFFFFFF) | 0xC0000000; |
| 671 | temp &= 0xfffffffe; |
| 672 | hwwrite(vortex->mmio, 0x24660, temp); |
| 673 | |
| 674 | } |
| 675 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 778 | static void vortex_XtalkHw_init(vortex_t * vortex) |
| 779 | { |
| 780 | vortex_XtalkHw_ZeroState(vortex); |
| 781 | } |
| 782 | |
| 783 | /* End of file */ |