freepad.c

Go to the documentation of this file.

/*
 * Copyright (c) 2007 Lukasz Bruun <mail@lukasz.dk>
 *
 * See the file LICENSE included with this distribution for licensing terms.
 */

 
#include "irx.h"
#include "types.h"
#include "ctype.h"
#include "stdio.h"
#include "loadcore.h"
#include "sysclib.h"
#include "sysmem.h"
#include "thevent.h"
#include "thbase.h"
#include "rpcserver.h"
#include "freepad.h"
 
extern struct irx_export_table _exp_padman;
 
// TODO: last sdk 3.1.0 and sdk 3.0.3 has PADMAN module version 0x04,0x22
// Check what was changed, and maybe port changes.
// Note: currently is based on the last XPADMAN from BOOTROM:
// 0x03,0x06
IRX_ID("padman", 3, 6);
 
extern int padman_init;
extern int thpri_hi;
extern int thpri_lo;
 
extern int vblank_end;
 
static int ParseParams(int argc, char *argv[])
{
    int new_thpri_hi, new_thpri_lo;
 
    new_thpri_hi = PADMAN_THPRI_HI;
    new_thpri_lo = PADMAN_THPRI_LO;
 
    if(argc > 1)
    {
        int i;
 
        argv++;
 
        for(i = 1; i < argc; i++,argv++)
        {
            if(strncmp("thpri=", *argv, 6) == 0)
            {
                const char *param;
 
                //Parse high priority
                param = &(*argv)[6];
                if(isdigit(*param))
                    new_thpri_hi = strtol(param, NULL, 10);
 
                //Skip value for high priority
                while(isdigit(*param))
                    param++;
 
                //Valid high priority parameter
                if(new_thpri_hi - 9 < 115)
                {
                    if(*param == ',')
                    {
                        ++param;
                        //Parse low priority
                        if(isdigit(*param))
                            new_thpri_lo = strtol(param, NULL, 10);
 
                        if(new_thpri_lo - 9 >= 115)
                        {
                            M_KPRINTF("invalid priority %d\n", new_thpri_lo);
                            return 0;
                        }
                    }
 
                    if(new_thpri_lo < new_thpri_hi)
                        M_PRINTF("high prio thread must be higher than low prio thread\n");
                }
                else
                {
                    M_KPRINTF("invalid priority %d\n", new_thpri_hi);
                    return 0;
                }
            }
        }
    }
 
    thpri_hi = new_thpri_hi;
    thpri_lo = new_thpri_lo;
 
    return 1;
}
 
int _start(int argc, char *argv[])
{
    padman_init = 0;
    vblank_end = 0;
    thpri_hi = PADMAN_THPRI_HI;
    thpri_lo = PADMAN_THPRI_LO;
 
    D_PRINTF("Debug Version\n");
 
    if(argc >= 2)
        ParseParams(argc, argv);
 
    if(thpri_hi != PADMAN_THPRI_HI || thpri_lo != PADMAN_THPRI_LO)
        M_PRINTF("thread priority: high=%d, low=%d\n", thpri_hi, thpri_lo);
 
    if(RegisterLibraryEntries(&_exp_padman) != 0)
    {
        M_PRINTF("RegisterLibraryEntries failed.\n");
        return MODULE_NO_RESIDENT_END;
    }
 
    if(InitRpcServers(thpri_lo) == 0)
    {
        M_PRINTF("Failed to init RPC servers.\n");
        return MODULE_NO_RESIDENT_END;
    }
 
    printf("Pad Driver for OSD\n");
 
    return MODULE_RESIDENT_END;
}
 
//This may have been a drop-in replacement for WaitEventFlag, which explains the similar, but unused 3rd and 4th parameters.
void WaitClearEvent(int eventflag, u32 bits, int mode, u32 *resbits_out)
{
    u32 resbits;
 
    (void)mode;
    (void)resbits_out;
 
    WaitEventFlag(eventflag, bits | EF_EXIT_THREAD, WEF_OR, &resbits);
 
    if( resbits & EF_EXIT_THREAD )
    {
        // Unofficial: remove unused ReferThreadStatus
        SetEventFlag(eventflag, EF_EXIT_THREAD);
        ExitThread();
    }
 
    ClearEventFlag(eventflag, ~bits);
}