Subversion Repositories NedoOS

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <oscalls.h>
#include <intrz80.h>
#include <terminal.c>
unsigned char key;
#define datareg 179
#define cmdreg 187
#include <booter.c>

unsigned char getStat(void)
{
    // Принять данные из регистра статуса
    unsigned char dataread;
    dataread = input(cmdreg);
    return dataread;
}

unsigned char getDat(void)
{
    // Принять данные из регистра данных
    unsigned char dataread;
    dataread = input(datareg);
    return dataread;
}

void sendDat(unsigned char data)
{
    // Послать код команды в регистр команд
    unsigned char dataread2;
    output(datareg, data);
    dataread2 = 128;
    while (dataread2 != 0)
    {
        dataread2 = (input(cmdreg) & 128);
    }
}

void sendDatnv(unsigned char data)
{
    // Послать данные в регистр данных, без ожидания готовности
    output(datareg, data);
}

void sendCmd(unsigned char command)
{
    // Послать код команды в регистр команд
    unsigned char dataread2;
    output(cmdreg, command);
    dataread2 = 1;
    while (dataread2 == 1)
    {
        dataread2 = input(cmdreg) & 1;
    }
}

void resetGS(void)
{
    sendCmd(0xF4);
}

unsigned long getMem(void)
{
    unsigned char ramL, ramM, RamH;
    sendCmd(0x20);
    ramL = getDat();
    ramM = getDat();
    RamH = getDat();
    return (65536 * RamH + 256 * ramM + ramL);
}

C_task main(void)
{
    unsigned char dataread, modHandle, q;
    unsigned long loadloop;
    os_initstdio();

    getDat();

    BOX(1, 1, 80, 25, 40);
    AT(1, 1);
    ATRIB(92);
    printf("GENERAL SOUND LOW LEVEL TESTER \r\n\r\n");

    printf("Testing  status register 0xBB \r\n");
    q = getStat() & 129; // 10000001

    switch (q)
    {

    case 0:
        printf("Data bit and Command bit are reset, OK. \r\n\r\n");
        break;
    case 129:
        printf("Data bit and Command bit are set, FAIL. Port is accessible? \r\n\r\n");
        break;
    case 128:
        printf("Data bit are set, FAIL. \r\n\r\n");
        break;
    case 1:
        printf("Command bit are set, FAIL. \r\n\r\n");
    default:
        printf("Error detecting status. RAW data(10000001): %u\r\n\r\n", q);
    }

    printf("Resetting GS... \r\n");
    resetGS();
    printf("Reset OK. Internal memory test...\r\n\r\n");

    dataread = 0;
    while (dataread == 0)
    {
        dataread = input(datareg);
    }

    printf("Reported by  boot: %u pages\r\n", dataread);
    printf("Reported by 0x20 : %lu bytes\r\n\r\n", getMem());

    sendCmd(0xFA);
    printf("sendCmd (0xFA) - test mode on;\r\n");
    sendCmd(11);
    printf("sendCmd (11)   - sound in chanel #1;\r\n");
    sendCmd(12);
    printf("sendCmd (12)   - sound in chanel #2;\r\n");
    sendCmd(13);
    printf("sendCmd (13)   - sound in chanel #3;\r\n");
    sendCmd(14);
    printf("sendCmd (14)   - sound in chanel #4;\r\n\r\n");

    printf("Uploading test tune...\r\n");
    sendCmd(0x30);
    modHandle = getDat();
    sendCmd(0xD1);
    for (loadloop = 0; loadloop < sizeof(rawData); loadloop++)
    {
        sendDat(rawData[loadloop]);
    }
    sendCmd(0xD2);
    loadloop = sizeof(rawData);
    printf("%lu bytes uploaded.\r\n", loadloop);
    sendDatnv(modHandle);
    sendCmd(0x31);
    printf("Playing handle %u...\r\n", modHandle);

    do
    {
        key = _low_level_get();
    } while (key == 0);
    sendCmd(0xf3);
    return 0;
}