#include <libps.h>
#include "control.h"

#define OT_LENGTH 1

void CheckControls(void);

PACKET packetaddress[2][100];
int currentbuffer;
GsOT OTtable[2];
GsOT_TAG OTtags[2][1<<OT_LENGTH];
int printstream[8],a;
 

int main()
{
        GsInitGraph(320,256,4,0,0);
        GsDefDispBuff(0,0,0,256);
                
        OTtable[0].length=OT_LENGTH;
        OTtable[1].length=OT_LENGTH;
        OTtable[0].org=OTtags[0];
        OTtable[1].org=OTtags[1];

        GetPadBuf(&padbuffer1,&padbuffer2); 

        FntLoad(960,256);
        for(a=0;a<8;a++)
        {
        printstream[a]=FntOpen(10,((a*10)+10),300,10,0,100);
        }

        for(;;)
        {
                currentbuffer = GsGetActiveBuff();
                GsSetWorkBase((PACKET *)packetaddress[currentbuffer]);
                GsClearOt(0,0,&OTtable[currentbuffer]);
                DrawSync(0);
                VSync(0);
                GsSwapDispBuff();
                GsSortClear(0,100,0,&OTtable[currentbuffer]);
                GsDrawOt(&OTtable[currentbuffer]);
                CheckControls();
                FntPrint(printstream[0],"Program to test control.h file");
                FntPrint(printstream[1],"Press Start & Select to reset");
                FntPrint(printstream[2],"Only works with standard pads");
                FntPrint(printstream[3],"~c900Controller 1 status:");
                FntPrint(printstream[6],"~c900Controller 2 status:");
                if(PAD1RESET || PAD2RESET)
                {
                        ResetGraph(0);
                        return(0);
                }
                for(a=0;a<8;a++)
                {
                FntFlush(printstream[a]);
                }
        }
        
}

/***********************************
* Function to check controllers.   *
* Only works with standard pads.   *
***********************************/

void CheckControls()
{
        /**********CHECK PAD ONE**********/
        if(PAD1UP)
        {                              
                FntPrint(printstream[4]," ~c990UP ");
        }
        if(PAD1DOWN)
        {
                FntPrint(printstream[4]," ~c990DOWN ");
        }
        if(PAD1RIGHT)
        {
                FntPrint(printstream[4]," ~c990RIGHT ");
        }
        if(PAD1LEFT)
        {
                FntPrint(printstream[4]," ~c990LEFT ");
        }
        if(PAD1CROSS)
        {
                FntPrint(printstream[4]," ~c990CROSS ");
        }
        if(PAD1SQUARE)
        {
                FntPrint(printstream[4]," ~c990SQUARE ");
        }
        if(PAD1TRIANGLE)
        {
                FntPrint(printstream[4]," ~c990TRIANGLE ");
        }
        if(PAD1CIRCLE)
        {
                FntPrint(printstream[4]," ~c990CIRCLE ");
        }
        if(PAD1R1)
        {
                FntPrint(printstream[4]," ~c990R1 ");
        }
        if(PAD1R2)
        {
                FntPrint(printstream[4]," ~c990R2 ");
        }
        if(PAD1L1)
        {
                FntPrint(printstream[4]," ~c990L1 ");
        }
        if(PAD1L2)
        {
                FntPrint(printstream[4]," ~c990L2 ");
        }
        if(PAD1SELECT)
        {
                FntPrint(printstream[4]," ~c990SELECT ");
        }
        if(PAD1START)
        {
                FntPrint(printstream[4]," ~c990START ");
        }

        /**********CHECK PAD TWO**********/
        if(PAD2UP)
        {
                FntPrint(printstream[7]," ~c990UP ");
        }
        if(PAD2DOWN)
        {
                FntPrint(printstream[7]," ~c990DOWN ");
        }
        if(PAD2RIGHT)
        {
                FntPrint(printstream[7]," ~c990RIGHT ");
        }
        if(PAD2LEFT)
        {
                FntPrint(printstream[7]," ~c990LEFT ");
        }
        if(PAD2CROSS)
        {
                FntPrint(printstream[7]," ~c990CROSS ");
        }
        if(PAD2SQUARE)
        {
                FntPrint(printstream[7]," ~c990SQUARE ");
        }
        if(PAD2TRIANGLE)
        {
                FntPrint(printstream[7]," ~c990TRIANGLE ");
        }
        if(PAD2CIRCLE)
        {
                FntPrint(printstream[7]," ~c990CIRCLE ");
        }
        if(PAD2R1)
        {
                FntPrint(printstream[7]," ~c990R1 ");
        }
        if(PAD2R2)
        {
                FntPrint(printstream[7]," ~c990R2 ");
        }
        if(PAD2L1)
        {
                FntPrint(printstream[7]," ~c990L1 ");
        }
        if(PAD2L2)
        {
                FntPrint(printstream[7]," ~c990L2 ");
        }
        if(PAD2SELECT)
        {
                FntPrint(printstream[7]," ~c990SELECT ");
        }
        if(PAD2START)
        {
                FntPrint(printstream[7]," ~c990START ");
        }
}