zlext.c

#include "vars.h"

#ifndef NOHAPTIC
#if defined(GCW)||defined(PCEGL)
#include <shake.h>
#include <unistd.h>
Shake_Device *device;
Shake_Effect effect, effect2, effect3;
int id, id2, id3;
void zlInitVibe(void){
	Shake_Init();
	if(Shake_NumOfDevices()>0) {
		device = Shake_Open(0);
		Shake_SimpleRumble(&effect,80.0,30.0,0.3);
		Shake_SimpleRumble(&effect2,60.0,20.0,0.2);
		Shake_SimpleRumble(&effect3,30.0,10.0,0.2);
		id = Shake_UploadEffect(device, &effect);
		id2 = Shake_UploadEffect(device, &effect2);
		id3 = Shake_UploadEffect(device, &effect3);
	}
}
void zlProcVibe(void){
	if (vibrogcw==3)
		Shake_Play(device, id);
	else if (vibrogcw==2)
		Shake_Play(device, id2);
	else if (vibrogcw==1)
		Shake_Play(device, id3);
	vibrogcw=0;
}
void zlShutDownVibe(void){
	Shake_EraseEffect(device, id);
	Shake_EraseEffect(device, id2);
	Shake_EraseEffect(device, id3);
	Shake_Close(device);
	Shake_Quit();
}
#endif
#endif
#ifdef GCW
#include "SDL/SDL.h"
SDL_Joystick *gamepad_sensor=NULL;
void zlInitGSensor(){
	for (int i = 0; i < SDL_NumJoysticks(); i++) //find the right joystick device for gsensor
	{
		if (strcmp(SDL_JoystickName(i), "mxc6225") == 0)
			gamepad_sensor = SDL_JoystickOpen(i);
	}
}
int x_correct=0;
int y_correct=0;
void zlProcGSensor(){
	int x,y,ix,iy;
	x=-SDL_JoystickGetAxis(gamepad_sensor,0)>>5; //this side up
	y=SDL_JoystickGetAxis(gamepad_sensor,1)>>5;
	if(gsensor_recentre==1) { //catch recentre flag
		x_correct=-x;
		y_correct=-y+512;
		gsensor_recentre=0;
	}

	ix=x+x_correct-gsensor[0]; //magic below here
	iy=y+y_correct-gsensor[1];

	gsensor[0]=x;
	gsensor[1]=y;

	int gsensor_filter=40;

	if (abs(ix)<gsensor_filter) ix=0;
	if (abs(iy)<gsensor_filter) iy=0;

	gsensor[3]=gsensor[3]+(ix-gsensor[3])/4;
	gsensor[4]=gsensor[4]+(iy-gsensor[4])/4;

	int gsensor_filter0=5;

	if (abs(gsensor[3])<gsensor_filter0) gsensor[3]=0;
	if (abs(gsensor[4])<gsensor_filter0) gsensor[4]=0;
}
void zlShutDownGSensor(){
	SDL_JoystickClose(gamepad_sensor);
}
#endif

#ifdef GP2XCAANOO
//Vibration

#include <stdio.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <unistd.h>

#include "zlext/simple_isa1200if.h"

#define DEVICE_FILENAME "/dev/isa1200"
int fd;
void zlInitVibe(void)
{
	fd=open(DEVICE_FILENAME,O_RDWR|O_NDELAY);
	ioctl(fd,IOCTL_MOTOR_DRV_ENABLE);
//ioctl(fd, IOCTL_SET_VIB_LEVEL, VIB_LEVEL_MAX);
}
pattern_data_t vibedata={
	.act_number=4,.vib_act_array={{0,126},{10,126},{20,126},{30,-126}}
};
void zlProcVibe(void)
{
	if (vibro>-64)
	{
		vibedata.vib_act_array[0].vib_strength=vibro;
		vibedata.vib_act_array[1].vib_strength=vibro;
		vibedata.vib_act_array[2].vib_strength=vibro;
		ioctl(fd, IOCTL_PLAY_PATTERN, &(vibedata));
	}
}

void zlShutDownVibe(void)
{
	ioctl(fd,IOCTL_MOTOR_DRV_DISABLE);
	close(fd);
}

// G-SENSOR

#include "zlext/te9_tf9_hybrid_driver.h"
//#include "zlext/te9_tf9_main.h"
#include "zlext/te9_tf9_regs.h"
#include <sys/types.h>
#include <sys/ipc.h>
#include <sys/sem.h>

#include <sys/wait.h>
#include <sys/poll.h>
#include <signal.h>
#include <errno.h>

int accel_fd;
struct sigaction sigact,oldact;
int exitIrqChecker=0;

static void irqChecker_sigHandler(int signo)
{
	switch(signo)
	{
	case SIGIO: KIONIX_ACCEL_service_interrupt();
		break;
	case SIGINT: case SIGQUIT: exitIrqChecker=1;
		break;
	}
	return;
}

void zlInitGSensor()
{
	accel_fd=open("/dev/accel",O_RDWR);
	int oflag;
/*

   sigact.sa_handler = irqChecker_sigHandler;
   sigemptyset(&sigact.sa_mask);
   sigact.sa_flags=SA_INTERRUPT;
   sigaction(SIGIO,&sigact,&oldact);
 */
	fcntl(accel_fd,F_SETOWN,getpid());
	oflag=fcntl(accel_fd,F_GETFL);
	fcntl(accel_fd,F_SETFL,oflag | FASYNC);

	KIONIX_ACCEL_init();
}

void zlProcGSensor()
{
	static ACCEL_XYZ accel_val;

	KIONIX_ACCEL_enable_outputs();
/*
   KIONIX_ACCEL_read_LPF_cnt(&accel_val.x, &accel_val.y, &accel_val.z);
   debug_v[0]=accel_val.x;
   debug_v[1]=accel_val.y;
   debug_v[2]=accel_val.z;
 */
	int x,y,z,ix,iy,iz;

	KIONIX_ACCEL_read_LPF_g(&x, &y, &z);

	ix=x-gsensor[0];
	iy=y-gsensor[1];
	iz=z-gsensor[2];

	gsensor[0]=x;
	gsensor[1]=y;
	gsensor[2]=z;

	int gsensor_filter=40;

	if (abs(ix)<gsensor_filter) ix=0;
	if (abs(iy)<gsensor_filter) iy=0;
	if (abs(iz)<gsensor_filter) iz=0;

	gsensor[3]=gsensor[3]+(ix-gsensor[3])/4;
	gsensor[4]=gsensor[4]+(iy-gsensor[4])/4;
	gsensor[5]=gsensor[5]+(iz-gsensor[5])/4;

	int gsensor_filter0=5;

	if (abs(gsensor[3])<gsensor_filter0) gsensor[3]=0;
	if (abs(gsensor[4])<gsensor_filter0) gsensor[4]=0;
	if (abs(gsensor[5])<gsensor_filter0) gsensor[5]=0;

}
void zlShutDownGSensor()
{
	KIONIX_ACCEL_deinit();
	close(accel_fd);
}

//
#endif

#ifdef GP2XCAANOO
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <unistd.h>
void caanoohack(void)
{
	volatile unsigned short *mregs;
	int mdev,i,prm,myram[8]={
		3,8,4,1,1,1,1,1
	};

	mdev=open("/dev/mem",O_RDWR);
	mregs=mmap(0,0x20000,PROT_READ|PROT_WRITE,MAP_SHARED,mdev,0xc0000000);
//myram

	prm=mregs[0x14802>>1] & 0x0f00;
	prm=prm|(myram[4]<<12)|(myram[5]<<4)|myram[6];
	mregs[0x14802>>1]=prm;
	prm=mregs[0x14804>>1]&0x4000;
	prm=prm|(myram[0]<<12)|(myram[1]<<8)|(myram[2]<<4)|myram[3];
	prm=prm|0x8000;
	mregs[0x14804>>1]=prm;
	for (i=0; i<0x100000 && (mregs[0x14804>>1]&0x8000); i++) ;
//myram
	munmap((void*)mregs,0x20000);
	close(mdev);
}
#endif

#ifdef GP2XWIZ

#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <unistd.h>
void wizhack(void)
{
	volatile unsigned short *mregs;
	int mdev,i,prm,myram[8]={
		3,9,4,1,1,1,1,1
	};
	mdev=open("/dev/mem",O_RDWR);
	mregs=mmap(0,0x20000,PROT_READ|PROT_WRITE,MAP_SHARED,mdev,0xc0000000);
//myram
	prm=mregs[0x14802>>1] & 0x0f00;
	prm=prm|(myram[4]<<12)|(myram[5]<<4)|myram[6];
	mregs[0x14802>>1]=prm;
	prm=mregs[0x14804>>1]&0x4000;
	prm=prm|(myram[0]<<12)|(myram[1]<<8)|(myram[2]<<4)|myram[3];
	prm=prm|0x8000;
	mregs[0x14804>>1]=prm;
	for (i=0; i<0x100000 && (mregs[0x14804>>1]&0x8000); i++) ;
//myram

/*
   int mhz=700;
   int mdiv,pdiv,sdiv=0;
   int v;
   pdiv=9;
   mdiv=(mhz*pdiv)/27;
   v=(pdiv<<18)|(mdiv<<8)|sdiv;
   mregs[0xf004>>2]=v;
   mregs[0xf07c>>2]|=0x8000;
   for (i=0;(mregs[0xf07c>>2]&0x8000)&&i<0x100000;i++);
 */

	munmap((void*)mregs,0x20000);
	close(mdev);
}
#endif

void zlextinit(void)
{
#if defined(GP2XCAANOO) || defined(GCW) || defined(PCEGL)
#ifndef NOHAPTIC
	zlInitVibe();
#endif
#ifndef PCEGL
	zlInitGSensor();
#endif
#endif
#ifdef GP2XCAANOO
	caanoohack();
#endif

#ifdef GP2XWZ
	wizhack();

#endif
}
void zlextframe(void)
{
	if (vibro>-64) vibro-=20;

#if defined(GP2XCAANOO) || defined(GCW) || defined(PCEGL)
#ifndef PCEGL
	if (configdata[11])
	{
		zlProcGSensor();
		consoleturn[1]+=((-gsensor[0]-consoleturn[1])>>4);
		consoleturn[0]+=(((1024-gsensor[1])-consoleturn[0])>>4);
	}
	else
	{
		gsensor[0]=0;
		gsensor[1]=0;
		gsensor[2]=0;
		gsensor[3]=0;
		gsensor[4]=0;
		gsensor[5]=0;
		consoleturn[0]=0;
		consoleturn[1]=0;
	}
#endif

#ifndef NOHAPTIC
	if (configdata[10]) zlProcVibe();
#ifdef GP2XCAANOO
	else vibro=-80;
#else
	else vibrogcw=0;
#endif
#endif

#endif
}

void zlextshutdown(void)
{
#if defined(GP2XCAANOO) || defined(GCW) || defined(PCEGL)
#ifndef NOHAPTIC
	zlShutDownVibe();
#endif
#ifndef PCEGL
	zlShutDownGSensor();
#endif
#endif
}