ps2cam_rpc.c

Go to the documentation of this file.

/*
  _____     ___ ____
   ____|   |    ____|      PSX2 OpenSource Project
  |     ___|   |____       (c) 2004-2005 Lion | (psxdever@hotmail.com)
*/
 
#include <tamtypes.h>
#include <kernel.h>
#include <sifrpc.h>
#include <stdio.h>
#include <string.h>
#include "../include/ps2cam_rpc.h"
 
 
 
#define PS2_CAM_RPC_ID      0x00FD000 +2
 
 
 
static int                  CamInited = 0;
static SifRpcClientData_t   cdata           __attribute__((aligned(64)));
static char                 data[1024]      __attribute__((aligned(64)));
static char                 campacket[896]  __attribute__((aligned(64)));
 
ee_sema_t compSema;
 
int sem;
 
 
 
 
int PS2CamInit(int mode)
{
    int             ret=0;
    int             *buf;
    // unsigned int i;
    // int timeout = 100000;
 
    if(CamInited)return 0;
 
    SifInitRpc(0);
 
    while (((ret = SifBindRpc(&cdata, PS2_CAM_RPC_ID, 0)) >= 0) && (cdata.server == NULL))
        nopdelay();
 
    nopdelay();
 
 
 
    if (ret < 0)return ret;
 
 
 
    buf     = (int *)&data[0];
    buf[0]  = mode;
 
    printf("bind done\n");
 
    SifCallRpc(&cdata, PS2CAM_RPC_INITIALIZE, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
    nopdelay();
 
    CamInited = 1;
 
printf("init done\n");
 
 
    compSema.init_count = 1;
    compSema.max_count = 1;
    compSema.option = 0;
    sem = CreateSema(&compSema);
 
printf("sema done\n");
 
    return buf[0];
}
 
 
 
 
 
int PS2CamGetIRXVersion(void)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    SifCallRpc(&cdata, PS2CAM_RPC_GETIRXVERSION, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
    nopdelay();
 
    return ret[0];
}
 
 
 
 
 
int PS2CamGetDeviceCount(void)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    SifCallRpc(&cdata, PS2CAM_RPC_GETDEVCOUNT, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
    nopdelay();
 
    return ret[0];
}
 
 
 
 
 
int PS2CamOpenDevice(int device_index)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    ret[0] = device_index;
 
    SifCallRpc(&cdata, PS2CAM_RPC_OPENDEVICE, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
 
    return ret[0];
}
 
 
 
 
int PS2CamCloseDevice(int handle)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
 
    SifCallRpc(&cdata, PS2CAM_RPC_CLOSEDEVICE, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
 
    return ret[0];
}
 
 
 
 
 
int PS2CamGetDeviceStatus(int handle)
{
    int *ret;
 
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
 
 
    SifCallRpc(&cdata, PS2CAM_RPC_GETDEVSTATUS, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
    nopdelay();
 
    return ret[0];
}
 
 
 
 
int PS2CamGetDeviceInfo(int handle, PS2CAM_DEVICE_INFO *info)
{
    int                 *ret;
    PS2CAM_DEVICE_INFO  *iop_info;
 
    ret         = (int *)&data[0];
    iop_info    = (PS2CAM_DEVICE_INFO *)&ret[1];
 
    ret[0] = handle;
 
    memcpy(iop_info, info, info->ssize);
 
    SifCallRpc(&cdata, PS2CAM_RPC_GETDEVINFO, 0, (void*)(&data[0]),info->ssize+4,(void*)(&data[0]),info->ssize+4,0,0);
    nopdelay();
 
    memcpy(info, iop_info, iop_info->ssize);
 
    return ret[0];
}
 
 
 
 
 
int PS2CamSetDeviceBandwidth(int handle, char bandwidth)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
    ret[1] = bandwidth;
 
 
 
    SifCallRpc(&cdata, PS2CAM_RPC_SETDEVBANDWIDTH, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
    nopdelay();
 
    return ret[0];
}
 
 
 
 
 
 
int PS2CamReadPacket(int handle)
{
    int *ret;
    int *iop_addr;
 
    WaitSema(sem);
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
 
    SifCallRpc(&cdata, PS2CAM_RPC_READPACKET, 0, (void*)(&data[0]),4,(void*)(&data[0]),4*2,0,0);
 
 
    if(ret[0] < 0) return ret[0];
 
 
    DI();
    ee_kmode_enter();
 
    iop_addr = (int *)(0xbc000000+ret[1]);
 
    memcpy(&campacket[0],iop_addr, ret[0]);
 
    ee_kmode_exit();
    EI();
 
    //if i add a printf here, the ps2 will exit to sony's explorer
    SignalSema(sem);
    return ret[0];
}
 
 
 
 
int PS2CamSetLEDMode(int handle, int mode)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
    ret[1] = mode;
 
    SifCallRpc(&cdata, PS2CAM_RPC_SETLEDMODE, 0, (void*)(&data[0]),4,(void*)(&data[0]),4,0,0);
 
    return ret[0];
}
 
 
 
int PS2CamSetDeviceConfig(int handle, PS2CAM_DEVICE_CONFIG *cfg)
{
    int *ret;
 
    ret = (int *)&data[0];
 
    ret[0] = handle;
 
    memcpy(&ret[1], cfg, cfg->ssize);
 
    SifCallRpc(&cdata, PS2CAM_RPC_SETDEVCONFIG, 0, (void*)(&data[0]), 4+cfg->ssize,(void*)(&data[0]),4+cfg->ssize,0,0);
 
    return ret[0];
}
 
 
 
int PS2CamExtractFrame(int handle, char *buffer, int bufsize)
{
    static int          capturing;
    static int          pos;
    static int          pic_size;
 
    (void)bufsize;
 
    pos                 = 0;
    capturing           = 0;
 
 
 
    while(1)
    {
        static EYETOY_FRAME_HEAD *head;
        static int ret;
 
        ret  = PS2CamReadPacket(handle);
 
    //  printf("packet =%d\n",ret);
        //if read has a error return it
        if(ret < 0) return ret;
 
        head = (EYETOY_FRAME_HEAD *)&campacket[0];
 
        if(head->magic2==0xff && head->magic3==0xff && ret!=0)
        {
            if(head->type==0x50 && head->frame==0x00)
            {
                // start of frame
            //  printf("SOF(%d)\n",ret);
                if(capturing == 1)
                {
                    return 0;
                }
 
                memcpy(&buffer[pos], &campacket[16], ret-16 );
                pos += (ret-16);
                capturing = 1;
 
            }
            else if(head->type==0x50 && head->frame==0x01)
            {
                // frame head with no data
                // so do nothing
 
            }
            else if(head->type==0x51 && capturing==1)
            {
                //end of frame
            //  printf("EOF(%d)\n",ret);
                pic_size = (int)(((head->Lo) + ((int)(head->Hi)<<8))<<3);
 
 
                if(pos != pic_size)
                {
                    return 0;
                }
                else
                {
                    return pic_size;
                }
            }
            else
            {
                //if it doesnt fit in those pos then it must be data
                if(capturing==1)
                {
                    memcpy(&buffer[pos], &campacket[0], ret );
                    pos += (ret);
                }
            }
        }
        else
        {
            // it must be data
            if(capturing==1 && ret !=0)
            {
                memcpy(&buffer[pos], &campacket[0], ret );
                pos += (ret);
            }
        }
    }
 
}