1
0
mirror of https://gitlab.os-k.eu/os-k-team/os-k.git synced 2023-08-25 14:03:10 +02:00
os-k/kaleid/kernel/io/spkr.c

100 lines
3.6 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 <kernel/speaker.h>
#include <kernel/iomisc.h>
#include <kernel/time.h>
void IoStartSpeaker(int freq)
{
char temp;
int pitf = 1193180 / freq;
ulong flags = KePauseIRQs();
IoWriteByteOnPort(0x43, 0xB6);
IoWriteByteOnPort(0x42, (char)pitf);
IoWriteByteOnPort(0x42, (char)(pitf >> 8));
temp = IoReadByteFromPort(0x61);
if (temp != (temp | 3)) {
IoWriteByteOnPort(0x61, temp | 3);
}
KeRestoreIRQs(flags);
}
void IoQuietSpeaker(void)
{
IoWriteByteOnPort(0x61, IoReadByteFromPort(0x61) & 0xFC);
}
void IoDoBeep(void)
{
IoStartSpeaker(1000);
IoRtcWait(100);
IoQuietSpeaker();
}
void IoDoTone(uint tone, uint time)
{
IoStartSpeaker(tone);
IoRtcWait(time);
IoQuietSpeaker();
}
void IoDoStarWars(void)
{
IoDoTone(0,0);
struct Note {
uint tone;
uint time;
};
struct Note Score[40] = { {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}
} ;
for (int i=0; i<40 ; i++) {
IoDoTone(Score[i].tone, Score[i].time);
KePauseCPU();
}
}