#include "emulator.h"
#include "speaker.h"
-#include "io.h"
#include "timer.h"
/* Extra PSDK/NDK Headers */
#include <ndk/obfuncs.h>
#include <ndk/rtlfuncs.h>
+/* Extra PSDK/NDK Headers */
+#include <ndk/kefuncs.h>
+
/* DDK Driver Headers */
#include <ntddbeep.h>
static HANDLE hBeep = NULL;
-/* PRIVATE FUNCTIONS **********************************************************/
+static LARGE_INTEGER FreqCount, CountStart;
+static ULONG PulseTickCount = 0, FreqPulses = 0;
-static DWORD OldReloadValue = 0;
-static PIT_MODE OldMode = 0;
+#define SPEAKER_RESPONSE 200 // in milliseconds
+
+#define MIN_AUDIBLE_FREQ 20 // BEEP_FREQUENCY_MINIMUM
+#define MAX_AUDIBLE_FREQ 20000 // BEEP_FREQUENCY_MAXIMUM
+#define CLICK_FREQ 100
-/* PUBLIC FUNCTIONS ***********************************************************/
-VOID PlaySound(DWORD Frequency,
- DWORD Duration)
+/* PRIVATE FUNCTIONS **********************************************************/
+
+static
+VOID
+MakeBeep(ULONG Frequency,
+ ULONG Duration)
{
- /* Adapted from kernel32:Beep() */
+ static ULONG LastFrequency = 0, LastDuration = 0;
IO_STATUS_BLOCK IoStatusBlock;
BEEP_SET_PARAMETERS BeepSetParameters;
- /* Set beep data */
+ /*
+ * Do nothing if we are replaying exactly the same sound
+ * (this avoids hiccups due to redoing the same beeps).
+ */
+ if (Frequency == LastFrequency && Duration == LastDuration) return;
+
+ /* A null frequency means we stop beeping */
+ if (Frequency == 0) Duration = 0;
+
+ /*
+ * For small durations we automatically reset the beep so
+ * that we can replay short beeps like clicks immediately.
+ */
+ if (Duration < 10)
+ {
+ LastFrequency = 0;
+ LastDuration = 0;
+ }
+ else
+ {
+ LastFrequency = Frequency;
+ LastDuration = Duration;
+ }
+
+ /* Set the data and do the beep */
BeepSetParameters.Frequency = Frequency;
BeepSetParameters.Duration = Duration;
- /* Send the beep */
NtDeviceIoControlFile(hBeep,
NULL,
NULL,
0);
}
-VOID SpeakerChange(VOID)
+static
+VOID PulseSample(VOID)
{
- BYTE Port61hState = IOReadB(CONTROL_SYSTEM_PORT61H);
- BOOLEAN IsConnectedToPITChannel2 = !!(Port61hState & 0x01);
- BOOLEAN SpeakerDataOn = !!(Port61hState & 0x02);
+ static ULONG Pulses = 0, CountStartTick = 0, LastPulsesFreq = 0;
+ ULONG LastPulseTickCount, CurrPulsesFreq;
+ LARGE_INTEGER Counter;
+ LONGLONG Elapsed;
+
+ /*
+ * Check how far away was the previous pulse and
+ * if it was >= 200ms away then restart counting.
+ */
+ LastPulseTickCount = PulseTickCount;
+ PulseTickCount = GetTickCount();
+ if (PulseTickCount - LastPulseTickCount >= SPEAKER_RESPONSE)
+ {
+ CountStart.QuadPart = 0;
+ Pulses = 0;
+ FreqPulses = 0;
+ return;
+ }
+
+ /* We have closely spaced pulses. Start counting. */
+ if (CountStart.QuadPart == 0)
+ {
+ NtQueryPerformanceCounter(&CountStart, NULL);
+ CountStartTick = PulseTickCount;
+ Pulses = 0;
+ FreqPulses = 0;
+ return;
+ }
+
+ /* A pulse is ongoing */
+ ++Pulses;
- if (PitChannel2 && IsConnectedToPITChannel2 && SpeakerDataOn)
+ /* We require some pulses to have some statistics */
+ if (PulseTickCount - CountStartTick <= (SPEAKER_RESPONSE >> 1)) return;
+
+ /* Get count time */
+ NtQueryPerformanceCounter(&Counter, NULL);
+
+ /*
+ * Get the number of speaker hundreds of microseconds that have passed
+ * since we started counting.
+ */
+ Elapsed = (Counter.QuadPart - CountStart.QuadPart) * 10000 / FreqCount.QuadPart;
+ if (Elapsed == 0) ++Elapsed;
+
+ /* Update counting for next pulses */
+ CountStart = Counter;
+ CountStartTick = PulseTickCount;
+
+ // HACKHACK!! I need to check why we need to double the number
+ // of pulses in order to have the correct frequency...
+ Pulses <<= 1;
+
+ /* Get the current pulses frequency */
+ CurrPulsesFreq = 10000 * Pulses / Elapsed;
+
+ /* Round the current pulses frequency up and align */
+ if ((CurrPulsesFreq & 0x0F) > 7) CurrPulsesFreq += 0x10;
+ CurrPulsesFreq &= ~0x0F;
+
+ /* Reinitialize frequency counters if necessary */
+ if (LastPulsesFreq == 0) LastPulsesFreq = CurrPulsesFreq;
+ if (FreqPulses == 0) FreqPulses = LastPulsesFreq;
+
+ /* Fix up the current pulses frequency if needed */
+ if (LastPulsesFreq != 0 && CurrPulsesFreq == 0)
+ CurrPulsesFreq = LastPulsesFreq;
+
+ /*
+ * Magic begins there...
+ */
+#ifndef ABS
+#define ABS(x) ((x) < 0 ? -(x) : (x))
+#endif
+ if (ABS(CurrPulsesFreq - LastPulsesFreq) > 7)
+ {
+ /*
+ * This can be a "large" fluctuation so ignore it for now, but take
+ * it into account if it happens to be a real frequency change.
+ */
+ CurrPulsesFreq = (CurrPulsesFreq + LastPulsesFreq) >> 1;
+ }
+ else
{
- /* Start beeping */
+ // FreqPulses = ((FreqPulses << 2) + LastPulsesFreq + CurrPulsesFreq) / 6;
+ FreqPulses = ((FreqPulses << 1) + LastPulsesFreq + CurrPulsesFreq) >> 2;
+ }
+
+ /* Round the pulses frequency up and align */
+ if ((FreqPulses & 0x0F) > 7) FreqPulses += 0x10;
+ FreqPulses &= ~0x0F;
- DWORD Frequency, Duration;
+ DPRINT("FreqPulses = %d, LastPulsesFreq = %d, CurrPulsesFreq = %d, Pulses = %d, Elapsed = %d\n",
+ FreqPulses, LastPulsesFreq, CurrPulsesFreq, Pulses, Elapsed);
- DWORD PitChannel2ReloadValue = PitChannel2->ReloadValue;
- if (PitChannel2ReloadValue == 0) PitChannel2ReloadValue = 65536;
+ LastPulsesFreq = CurrPulsesFreq;
+ Pulses = 0;
+}
- DPRINT("(1) PitChannel2(Mode = %d ; ReloadValue = %d)\n", PitChannel2->Mode, PitChannel2ReloadValue);
- if (OldMode == PitChannel2->Mode && OldReloadValue == PitChannel2ReloadValue)
- return;
+/* PUBLIC FUNCTIONS ***********************************************************/
- OldMode = PitChannel2->Mode;
- OldReloadValue = PitChannel2ReloadValue;
+// SpeakerPulse
+VOID SpeakerChange(UCHAR Port61hValue)
+{
+ static BOOLEAN OldSpeakerOff = TRUE;
- DPRINT("(2) PitChannel2(Mode = %d ; ReloadValue = %d)\n", PitChannel2->Mode, PitChannel2ReloadValue);
+ BOOLEAN Timer2Gate = !!(Port61hValue & 0x01);
+ BOOLEAN SpeakerOn = !!(Port61hValue & 0x02);
- Frequency = (PIT_BASE_FREQUENCY / PitChannel2ReloadValue);
- Duration = INFINITE;
+ DPRINT("SpeakerChange -- Timer2Gate == %s ; SpeakerOn == %s\n",
+ Timer2Gate ? "true" : "false", SpeakerOn ? "true" : "false");
- PlaySound(Frequency, Duration);
+ if (Timer2Gate)
+ {
+ if (SpeakerOn)
+ {
+ /* Start beeping */
+ ULONG Frequency = (PIT_BASE_FREQUENCY / PitGetReloadValue(2));
+ if (Frequency < MIN_AUDIBLE_FREQ || MAX_AUDIBLE_FREQ < Frequency)
+ Frequency = 0;
+
+ MakeBeep(Frequency, INFINITE);
+ }
+ else
+ {
+ /* Stop beeping */
+ MakeBeep(0, 0);
+ }
}
else
{
- /* Stop beeping */
+ if (SpeakerOn)
+ {
+ if (OldSpeakerOff)
+ {
+ OldSpeakerOff = FALSE;
+ PulseSample();
+ }
+
+ if (FreqPulses >= MIN_AUDIBLE_FREQ)
+ MakeBeep(FreqPulses, INFINITE);
+ else if (CountStart.QuadPart != 0)
+ MakeBeep(CLICK_FREQ, 1); /* Click */
+ else
+ MakeBeep(0, 0); /* Stop beeping */
+ }
+ else
+ {
+ OldSpeakerOff = TRUE;
- OldMode = 0;
- OldReloadValue = 0;
+ /*
+ * Check how far away was the previous pulse and if
+ * it was >= (200 + eps) ms away then stop beeping.
+ */
+ if (GetTickCount() - PulseTickCount >= SPEAKER_RESPONSE + (SPEAKER_RESPONSE >> 3))
+ {
+ CountStart.QuadPart = 0;
+ FreqPulses = 0;
- PlaySound(0x00, 0x00);
+ /* Stop beeping */
+ MakeBeep(0, 0);
+ }
+ }
}
}
OBJECT_ATTRIBUTES ObjectAttributes;
IO_STATUS_BLOCK IoStatusBlock;
- /* Adapted from kernel32:Beep() */
+ /* Retrieve the performance frequency and initialize the timer ticks */
+ NtQueryPerformanceCounter(&CountStart, &FreqCount);
+ if (FreqCount.QuadPart == 0)
+ {
+ wprintf(L"FATAL: Performance counter not available\n");
+ }
- /* Open the device */
+ /* Open the BEEP device */
RtlInitUnicodeString(&BeepDevice, L"\\Device\\Beep");
InitializeObjectAttributes(&ObjectAttributes, &BeepDevice, 0, NULL, NULL);
Status = NtCreateFile(&hBeep,
0);
if (!NT_SUCCESS(Status))
{
- DPRINT1("Failed to open Beep driver, Status 0x%08lx\n", Status);
+ DPRINT1("Failed to open the Beep driver, Status 0x%08lx\n", Status);
+ // hBeep = INVALID_HANDLE_VALUE;
}
}
projects / reactos.git / commitdiff