os-k/kaleid/kernel/io/spkr.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 <libbuf.h>

extern bool KeIdtIsInitialized;

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} };

void IoStartSpeaker(ulong freq)
{
    uchar temp;
    ulong 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(ulong tone, ulong time)
{
    IoStartSpeaker(tone);
    KeSleep(time);
}

static void IoDoToneNoIdt(ulong tone, ulong 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)
{
    for (uint i = 0; i < 40; i++) {
        IoDoTone(score[i].tone, score[i].time);
    }
    IoQuietSpeaker();

    //bprintf(BStdOut, "FINISHED\n");
}