- Update to r53061
[reactos.git] / drivers / multimedia / audio / sb16_nt4.old / control.c
1 #include <sndblst.h>
2
3 /*
4 TODO: MmMapIoSpace()
5 */
6
7 /*
8 This checks the read or write status port of the device.
9 */
10
11 BOOLEAN
12 WaitForReady(
13 PSOUND_BLASTER_PARAMETERS SBDevice,
14 UCHAR Port)
15 {
16 ULONG timeout = SB_TIMEOUT;
17 BOOL ready = FALSE;
18
19 while ( ( ! ready ) && ( timeout > 0 ) )
20 {
21 if ( SbRead(SBDevice, Port) & 0x80 )
22 return TRUE;
23
24 timeout --;
25 }
26
27 return FALSE;
28 }
29
30 BOOLEAN
31 SbWriteData(
32 PSOUND_BLASTER_PARAMETERS SBDevice,
33 UCHAR Data)
34 {
35 if ( ! WaitToWrite(SBDevice) )
36 return FALSE;
37
38 DPRINT("Writing 0x%x to Sound Blaster card (data)\n", Data);
39 SbWrite(SBDevice, SB_WRITE_DATA_PORT, Data);
40
41 return TRUE;
42 }
43
44 BOOLEAN
45 SbReadData(
46 PSOUND_BLASTER_PARAMETERS SBDevice,
47 PUCHAR Data)
48 {
49 if ( ! WaitToWrite(SBDevice) )
50 return FALSE;
51
52 *Data = SbRead(SBDevice, SB_READ_DATA_PORT);
53 DPRINT("Read 0x%x from Sound Blaster card (data)\n", *Data);
54
55 return TRUE;
56 }
57
58 BOOLEAN
59 ResetSoundBlaster(
60 PSOUND_BLASTER_PARAMETERS SBDevice)
61 {
62 BOOLEAN acked = FALSE;
63 ULONG timeout;
64
65 SbWriteReset(SBDevice, 0x01);
66 for (timeout = 0; timeout < 30000; timeout ++ );
67 SbWriteReset(SBDevice, 0x00);
68
69 DPRINT("Waiting for SB to acknowledge our reset request\n");
70
71 if ( ! WaitToRead(SBDevice) )
72 {
73 DPRINT("Didn't get an ACK :(\n");
74 return FALSE;
75 }
76
77 timeout = 0;
78
79 while ( ( ! acked ) && ( timeout < SB_TIMEOUT ) )
80 {
81 acked = ( SbReadDataWithoutWait(SBDevice) == SB_DSP_READY );
82 timeout ++;
83 }
84
85 if ( ! acked )
86 {
87 DPRINT("Didn't get an ACK :(\n");
88 return FALSE;
89 }
90
91 return TRUE;
92 }
93
94 ULONG
95 GetSoundBlasterModel(
96 PSOUND_BLASTER_PARAMETERS SBDevice)
97 {
98 UCHAR MajorVer, MinorVer;
99
100 DPRINT("Querying DSP version\n");
101
102 if ( ! SbWriteData(SBDevice, SbGetDspVersion) )
103 return NotDetected;
104
105 if ( ! WaitToRead(SBDevice) )
106 return NotDetected;
107
108 if ( SbReadData(SBDevice, &MajorVer) )
109 {
110 if ( SbReadData(SBDevice, &MinorVer) )
111 {
112 DPRINT("Version %d.%d\n", MajorVer, MinorVer);
113
114 SBDevice->dsp_version = (MajorVer * 256) + MinorVer;
115
116 if ( SBDevice->dsp_version < 0x0200 )
117 return SoundBlaster;
118 else if ( ( SBDevice->dsp_version & 0xFF00 ) == 0x0200 )
119 return SoundBlaster2;
120 else if ( ( SBDevice->dsp_version & 0xFF00 ) == 0x0300 )
121 return SoundBlasterPro;
122 else if ( SBDevice->dsp_version >= 0x0400 )
123 return SoundBlaster16;
124
125 return NotDetected;
126 }
127 }
128
129 return NotDetected;
130 }
131
132
133 BOOLEAN
134 IsSampleRateCompatible(
135 PSOUND_BLASTER_PARAMETERS SBDevice,
136 ULONG SampleRate)
137 {
138 /* TODO */
139 return TRUE;
140 }
141
142 BOOLEAN
143 SetOutputSampleRate(
144 PSOUND_BLASTER_PARAMETERS SBDevice,
145 ULONG SampleRate)
146 {
147 /* Only works for DSP v4.xx */
148 DPRINT("Setting sample rate\n");
149
150 SbWriteData(SBDevice, SbSetOutputRate);
151 SbWriteData(SBDevice, SampleRate / 256);
152 SbWriteData(SBDevice, SampleRate % 256);
153
154 return TRUE;
155 }
156
157 BOOLEAN
158 EnableSpeaker(
159 PSOUND_BLASTER_PARAMETERS SBDevice)
160 {
161 DPRINT("Enabling speaker\n");
162
163 return SbWriteData(SBDevice, SbEnableSpeaker);
164 }
165
166 BOOLEAN
167 DisableSpeaker(
168 PSOUND_BLASTER_PARAMETERS SBDevice)
169 {
170 DPRINT("Disabling speaker\n");
171
172 return SbWriteData(SBDevice, SbDisableSpeaker);
173 }
174
175 BOOLEAN
176 StartSoundOutput(
177 PSOUND_BLASTER_PARAMETERS SBDevice,
178 ULONG BitDepth,
179 ULONG Channels,
180 ULONG BlockSize)
181 {
182 DPRINT("Initializing output with %d channels at %d bits/sample\n", Channels, BitDepth);
183
184 UCHAR command = 0xc6, mode = 0x00;
185
186 if ( ( Channels < 1 ) || ( Channels > 2 ) )
187 return FALSE;
188
189 if ( ( BitDepth != 8 ) && ( BitDepth != 16 ) )
190 return FALSE;
191
192 switch ( BitDepth )
193 {
194 case 8 : command = 0xc6; break;
195 case 16 : command = 0xb6; break;
196 };
197
198 switch ( Channels )
199 {
200 case 1 : mode = 0x00; break;
201 case 2 : mode = 0x20; break;
202 }
203 #if 0
204 first_byte = (BitDepth == 16) ? 0xb6 : 0xc6;
205 second_byte = (Channels == 1) ? 0x20 : 0x00;
206 #endif
207
208 if ( SBDevice->dsp_version < 0x0400 )
209 {
210 /* TODO: Additional programming required */
211 }
212
213 /* Send freq */
214 SbWriteData(SBDevice, command);
215 SbWriteData(SBDevice, mode);
216 SbWriteData(SBDevice, BlockSize % 256);
217 SbWriteData(SBDevice, BlockSize / 256);
218
219 DPRINT("Finished programming the DSP\n");
220
221 return TRUE;
222 }