kernel.cpp

//
// kernel.cpp
//
// Circle - A C++ bare metal environment for Raspberry Pi
// Copyright (C) 2014-2021  R. Stange <rsta2@o2online.de>
//
// This program 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
// (at your option) any later version.
//
// This program 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 this program.  If not, see <http://www.gnu.org/licenses/>.
//
#include "kernel.h"
#include "msx2def.h"
#include <circle/multicore.h>

// defined in multicoremanager.cpp
int16_t* getPreviousSoundBuffer(size_t* size);

#define TAG "kernel"
int msxPad1 = 0;
uint16_t* hdmiBuffer;
int hdmiPitch;
CVCHIQSoundDevice* hdmiSoundDevice;
CLogger* clogger;

CKernel::CKernel(void) : screen(640, 480),
                         timer(&interrupt),
                         logger(options.GetLogLevel(), &timer),
                         usb(&interrupt, &timer, TRUE),
                         vchiq(CMemorySystem::Get(), &interrupt),
                         sound(&vchiq, (TVCHIQSoundDestination)options.GetSoundOption()),
                         mcm(CMemorySystem::Get()),
                         gamePad(nullptr)
{
    led.Blink(5); // show we are alive
}

CKernel::~CKernel(void)
{
}

boolean CKernel::initialize(void)
{
    boolean bOK = TRUE;
    led.On();

    if (bOK) {
        bOK = screen.Initialize();
    }

    if (bOK) {
        bOK = serial.Initialize(115200);
    }

    if (bOK) {
        CDevice* target = deviceNameService.GetDevice(options.GetLogDevice(), FALSE);
        if (target == 0) {
            target = &screen;
        }
        bOK = logger.Initialize(target);
    }

    if (bOK) {
        logger.Write(TAG, LogNotice, "init interrupt");
        bOK = interrupt.Initialize();
    }

    if (bOK) {
        logger.Write(TAG, LogNotice, "init timer");
        bOK = timer.Initialize();
    }

    if (bOK) {
        logger.Write(TAG, LogNotice, "init vchiq");
        bOK = vchiq.Initialize();
    }

    if (bOK) {
        logger.Write(TAG, LogNotice, "init usb");
        bOK = usb.Initialize();
    }

    auto buffer = screen.GetFrameBuffer();
    hdmiPitch = buffer->GetPitch() / sizeof(TScreenColor);
    uint64_t bufferPointer = buffer->GetBuffer();
    hdmiBuffer = (uint16_t*)bufferPointer;

    if (bOK) {
        logger.Write(TAG, LogNotice, "init mcm");
        clogger = &logger;
        bOK = mcm.Initialize();
    }

    if (bOK) {
        led.Off();
    }
    return bOK;
}

TShutdownMode CKernel::run(void)
{
    sound.SetControl(VCHIQ_SOUND_VOLUME_MAX);
    hdmiSoundDevice = &sound;
    int swap = 0;
    while (1) {
        // peripheral devices proc
        if (usb.UpdatePlugAndPlay()) {
            if (!gamePad) {
                gamePad = (CUSBGamePadDevice*)deviceNameService.GetDevice("upad1", FALSE);
                if (gamePad) {
                    gamePad->RegisterStatusHandler([](unsigned index, const TGamePadState* state) {
                        msxPad1 = 0;
                        msxPad1 |= state->axes[0].value == state->axes[0].minimum ? MSX2_JOY_LE : 0;
                        msxPad1 |= state->axes[0].value == state->axes[0].maximum ? MSX2_JOY_RI : 0;
                        msxPad1 |= state->axes[1].value == state->axes[1].minimum ? MSX2_JOY_UP : 0;
                        msxPad1 |= state->axes[1].value == state->axes[1].maximum ? MSX2_JOY_DW : 0;
                        msxPad1 |= (state->buttons & 0x0001) ? MSX2_JOY_T2 : 0;
                        msxPad1 |= (state->buttons & 0x0002) ? MSX2_JOY_T1 : 0;
                        msxPad1 |= (state->buttons & 0x0100) ? MSX2_JOY_S2 : 0;
                        msxPad1 |= (state->buttons & 0x0200) ? MSX2_JOY_S1 : 0;
                    });
                }
            } else {
                if (!(CUSBGamePadDevice*)deviceNameService.GetDevice("upad1", FALSE)) {
                    gamePad = nullptr;
                    msxPad1 = 0;
                }
            }
        }

        // wait v-sync
        swap = 480 - swap;
        screen.GetFrameBuffer()->SetVirtualOffset(0, swap);
        screen.GetFrameBuffer()->WaitForVerticalSync();

        // output sound
        size_t pcmSize;
        int16_t* pcmData = getPreviousSoundBuffer(&pcmSize);
        if (0 < pcmSize) {
            // playback
            while (sound.PlaybackActive()) {
                ;
            }
            sound.Playback(pcmData, pcmSize / 4, 2, 16);
        }

        // request MSX tick to core-1
        CMultiCoreSupport::SendIPI(1, IPI_USER + 0);
    }
    return ShutdownHalt;
}