112 lines
4.0 KiB
C
112 lines
4.0 KiB
C
//----------------------------------------------------------------------------//
|
|
// GNU GPL OS/K //
|
|
// //
|
|
// Desc: Speaker functions //
|
|
// //
|
|
// //
|
|
// Copyright © 4018-4019 The OS/K Team //
|
|
// //
|
|
// This file is part of OS/K. //
|
|
// //
|
|
// OS/K is free software: you can redistribute it and/or modify //
|
|
// it under the terms of the GNU General Public License as published by //
|
|
// the Free Software Foundation, either version 3 of the License, or //
|
|
// any later version. //
|
|
// //
|
|
// OS/K is distributed in the hope that it will be useful, //
|
|
// but WITHOUT ANY WARRANTY//without even the implied warranty of //
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the //
|
|
// GNU General Public License for more details. //
|
|
// //
|
|
// You should have received a copy of the GNU General Public License //
|
|
// along with OS/K. If not, see <https://www.gnu.org/licenses/>. //
|
|
//----------------------------------------------------------------------------//
|
|
|
|
#include <io/spkr.h>
|
|
#include <ke/time.h>
|
|
#include <lib/buf.h>
|
|
|
|
extern bool KeIdtIsInitialized;
|
|
|
|
void IoStartSpeaker(int freq)
|
|
{
|
|
uchar temp;
|
|
uint pitf = 1193180 / freq;
|
|
|
|
ulong flags = KePauseIRQs();
|
|
IoWriteByteOnPort(0x43, 0xB6);
|
|
IoWriteByteOnPort(0x42, (uchar)pitf);
|
|
IoWriteByteOnPort(0x42, (uchar)(pitf >> 8));
|
|
|
|
temp = IoReadByteFromPort(0x61);
|
|
if (temp != (temp | 3)) {
|
|
IoWriteByteOnPort(0x61, temp | 3);
|
|
}
|
|
KeRestoreIRQs(flags);
|
|
}
|
|
|
|
static inline void IoQuietSpeaker(void)
|
|
{
|
|
ulong flags = KePauseIRQs();
|
|
IoWriteByteOnPort(0x61, IoReadByteFromPort(0x61) & 0xFC);
|
|
KeRestoreIRQs(flags);
|
|
}
|
|
|
|
void IoDoTone(uint tone, uint time)
|
|
{
|
|
IoStartSpeaker(tone);
|
|
KeSleep(time);
|
|
}
|
|
|
|
static void IoDoToneNoIdt(uint tone, uint time)
|
|
{
|
|
extern void temporize(void);
|
|
IoStartSpeaker(tone);
|
|
for (int i = 0; i < 100; i++) temporize();
|
|
IoQuietSpeaker();
|
|
}
|
|
|
|
void IoDoBeep(void)
|
|
{
|
|
if (KeIdtIsInitialized) {
|
|
IoDoTone(1000, 100);
|
|
IoQuietSpeaker();
|
|
}
|
|
}
|
|
|
|
void IoDoBeepNoIdt(void)
|
|
{
|
|
IoDoToneNoIdt(1000, 100);
|
|
}
|
|
|
|
void IoDoStarWars(void)
|
|
{
|
|
struct Note {
|
|
uint tone;
|
|
uint time;
|
|
};
|
|
|
|
struct Note score[] = { {440, 200}, {110, 200}, {440, 200}, {110, 200},
|
|
{440, 200}, {110, 200}, {349, 140}, {87, 100},
|
|
{523, 60}, {87, 100}, {440, 200}, {110, 200},
|
|
{349, 140}, {87, 100}, {523, 60}, {87, 100},
|
|
{440, 200}, {110, 200}, {440, 200}, {110, 200},
|
|
{659, 200}, {110, 200}, {659, 200}, {110, 200},
|
|
{659, 200}, {87, 200}, {698, 140}, {87, 100},
|
|
{523, 60}, {87, 100}, {415, 200}, {87, 200},
|
|
{349, 140}, {87, 100}, {523, 60}, {87, 100},
|
|
{440, 200}, {110, 200}, {110, 200}, {110, 200}
|
|
};
|
|
|
|
//bprintf(BStdOut, "\n");
|
|
|
|
for (uint i = 0; i < sizeof(score)/sizeof(struct Note); i++) {
|
|
IoDoTone(score[i].tone, score[i].time);
|
|
//bprintf(BStdOut, "%d ", i);
|
|
//BStdOut->flusher(BStdOut);
|
|
}
|
|
IoQuietSpeaker();
|
|
|
|
//bprintf(BStdOut, "FINISHED\n");
|
|
}
|