#include <global.h>
#include <ultra64/hardware.h>

void __osDevMgrMain(void* arg)
{
    OSIoMesg* ioMesg;
    OSMesg sp70;
    OSMesg sp6C;
    OSMgrArgs* arg0;
    __OSTranxInfo* transfer;
    __OSBlockInfo* block;
    s32 phi_s2;
    s32 phi_s0;
    u32 sp54;

    arg0 = (OSMgrArgs*)arg;
    ioMesg = NULL;

    while (true)
    {
        osRecvMesg(arg0->cmdQueue, (OSMesg)&ioMesg, OS_MESG_BLOCK);
        if ((ioMesg->piHandle != NULL) && (ioMesg->piHandle->type == DEVICE_TYPE_64DD) && 
            ((ioMesg->piHandle->transferInfo.cmdType == 0) || (ioMesg->piHandle->transferInfo.cmdType == 1)))
        {
            transfer = &ioMesg->piHandle->transferInfo;
            block = &transfer->block[transfer->blockNum];
            transfer->sectorNum = -1;
            if (transfer->transferMode != 3)
                block->dramAddr = (void*)((u32)block->dramAddr - block->sectorSize);

            phi_s2 = ((transfer->transferMode == 2) && (ioMesg->piHandle->transferInfo.cmdType == 0)) ? 1 : 0;

            osRecvMesg(arg0->acccessQueue, &sp6C, OS_MESG_BLOCK);
            __osResetGlobalIntMask(0x00100401);
            __osEPiRawWriteIo(ioMesg->piHandle, 0x05000510, transfer->bmCtlShadow | 0x80000000);

            while (true)
            {
                osRecvMesg(arg0->eventQueue, &sp70, OS_MESG_BLOCK);
                transfer = &ioMesg->piHandle->transferInfo;
                block = &transfer->block[transfer->blockNum];
                if (block->errStatus == 0x1D)
                {
                    __osEPiRawWriteIo(ioMesg->piHandle, 0x05000510, transfer->bmCtlShadow | 0x10000000);
                    __osEPiRawWriteIo(ioMesg->piHandle, 0x05000510, transfer->bmCtlShadow);
                    __osEPiRawReadIo(ioMesg->piHandle, 0x05000508, &sp54);
                    if (sp54 & 0x02000000)
                        __osEPiRawWriteIo(ioMesg->piHandle, 0x05000510, transfer->bmCtlShadow | 0x1000000);
                    block->errStatus = 4;
                    HW_REG(PI_STATUS_REG, u32) = PI_STATUS_CLEAR_INTR;
                    __osSetGlobalIntMask(0x00100C01);
                }
                osSendMesg(ioMesg->hdr.retQueue, ioMesg, OS_MESG_NOBLOCK);

                if ((phi_s2 != 1) || (ioMesg->piHandle->transferInfo.block[0].errStatus != 0))
                    break;

                phi_s2 = 0;
            }

            osSendMesg(arg0->acccessQueue, 0, OS_MESG_NOBLOCK);
            if (ioMesg->piHandle->transferInfo.blockNum == 1)
                osYieldThread();
        }
        else
        {
            switch (ioMesg->hdr.type)
            {
                case 11:
                    osRecvMesg(arg0->acccessQueue, &sp6C, OS_MESG_BLOCK);
                    phi_s0 = arg0->piDmaCallback(OS_READ, ioMesg->devAddr, ioMesg->dramAddr, ioMesg->size);
                    break;
                case 12:
                    osRecvMesg(arg0->acccessQueue, &sp6C, OS_MESG_BLOCK);
                    phi_s0 = arg0->piDmaCallback(OS_WRITE, ioMesg->devAddr, ioMesg->dramAddr, ioMesg->size);
                    break;
                case 15:
                    osRecvMesg(arg0->acccessQueue, &sp6C, OS_MESG_BLOCK);
                    phi_s0 = arg0->epiDmaCallback(ioMesg->piHandle, OS_READ, ioMesg->devAddr, ioMesg->dramAddr, ioMesg->size);
                    break;
                case 16:
                    osRecvMesg(arg0->acccessQueue, &sp6C, OS_MESG_BLOCK);
                    phi_s0 = arg0->epiDmaCallback(ioMesg->piHandle, OS_WRITE, ioMesg->devAddr, ioMesg->dramAddr, ioMesg->size);
                    break;
                case 10:
                    osSendMesg(ioMesg->hdr.retQueue, ioMesg, OS_MESG_NOBLOCK);
                    phi_s0 = -1;
                    break;
                default:
                    phi_s0 = -1;
                    break;
            }

            if (phi_s0 == 0)
            {
                osRecvMesg(arg0->eventQueue, &sp70, OS_MESG_BLOCK);
                osSendMesg(ioMesg->hdr.retQueue, ioMesg, OS_MESG_NOBLOCK);
                osSendMesg(arg0->acccessQueue, NULL, OS_MESG_NOBLOCK);
            }
        }
    }
}