//----------------------------------------------------------------------------//
//                           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>

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)
{
    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();
    }
}