Files
pcsx2-sourceforge/plugins/pad/zeropad/Linux/linux.cpp
2007-12-12 17:19:07 +00:00

900 lines
26 KiB
C++

/* ZeroPAD - author: zerofrog(@gmail.com)
* Copyright (C) 2006-2007
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include <string.h>
#include <gtk/gtk.h>
#include <pthread.h>
#ifdef JOYSTICK_SUPPORT
#include <linux/joystick.h>
#include <linux/input.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <unistd.h>
#include <signal.h>
#include <errno.h>
#endif
#include "zeropad.h"
extern "C" {
#include "interface.h"
#include "support.h"
#include "callbacks.h"
}
Display *GSdsp;
static pthread_spinlock_t s_mutexStatus;
static u32 s_keyPress[2], s_keyRelease[2]; // thread safe
// holds all joystick info
class JoystickInfo
{
public:
JoystickInfo();
~JoystickInfo() { Destroy(); }
void Destroy();
// opens handles to all possible joysticks
static void EnumerateJoysticks(vector<JoystickInfo*>& vjoysticks);
bool Init(const char* pdev, int id, bool bStartThread=true); // opens a handle and gets information
void Assign(int pad); // assigns a joystick to a pad
void ProcessData(); // reads data from the joystick
void TestForce();
const string& GetName() { return devname; }
int GetNumButtons() { return vbuttonstate.size(); }
int GetButtonState(int ibut) { return vbuttonstate[ibut]; }
int GetNumAxes() { return vaxes.size(); }
int GetAxisState(int iaxis) { return vaxes[iaxis]; }
int GetVersion() { return version; }
int GetId() { return _id; }
int GetPAD() { return pad; }
private:
#ifdef JOYSTICK_SUPPORT
static void* pollthread(void* p);
void* _pollthread();
#endif
string devid; // device id
string devname; // pretty device name
int _id, js_fd;
vector<int> vbuttonstate;
vector<int> vaxes; // values of the axes
int axisrange;
int pad;
int version;
bool bTerminateThread;
pthread_t pthreadpoll;
};
static vector<JoystickInfo*> s_vjoysticks;
extern string s_strIniPath;
void SaveConfig()
{
int i, j;
FILE *f;
char cfg[255];
strcpy(cfg, s_strIniPath.c_str());
f = fopen(cfg,"w");
if (f == NULL) {
printf("ZeroPAD: failed to save ini %s\n", s_strIniPath.c_str());
return;
}
for (j=0; j<2; j++) {
for (i=0; i<PADKEYS; i++) {
fprintf(f, "[%d][%d] = 0x%lx\n", j, i, conf.keys[j][i]);
}
}
fprintf(f, "log = %d\n", conf.log);
fprintf(f, "options = %d\n", conf.options);
fclose(f);
}
static char* s_pGuiKeyMap[] = { "L2", "R2", "L1", "R1",
"Triangle", "Circle", "Cross", "Square",
"Select", "L3", "R3", "Start",
"Up", "Right", "Down", "Left",
"Lx", "Rx", "Ly", "Ry" };
string GetLabelFromButton(const char* buttonname)
{
string label = "e";
label += buttonname;
return label;
}
void LoadConfig() {
FILE *f;
char str[256];
char cfg[255];
int i, j;
memset(&conf, 0, sizeof(conf));
conf.keys[0][0] = XK_a; // L2
conf.keys[0][1] = XK_semicolon; // R2
conf.keys[0][2] = XK_w; // L1
conf.keys[0][3] = XK_p; // R1
conf.keys[0][4] = XK_i; // TRIANGLE
conf.keys[0][5] = XK_l; // CIRCLE
conf.keys[0][6] = XK_k; // CROSS
conf.keys[0][7] = XK_j; // SQUARE
conf.keys[0][8] = XK_v; // SELECT
conf.keys[0][11] = XK_n;// START
conf.keys[0][12] = XK_e; // UP
conf.keys[0][13] = XK_f; // RIGHT
conf.keys[0][14] = XK_d; // DOWN
conf.keys[0][15] = XK_s; // LEFT
conf.log = 0;
strcpy(cfg, s_strIniPath.c_str());
f = fopen(cfg, "r");
if (f == NULL) {
printf("ZeroPAD: failed to load ini %s\n", s_strIniPath.c_str());
SaveConfig();//save and return
return;
}
for (j=0; j<2; j++) {
for (i=0; i<PADKEYS; i++) {
sprintf(str, "[%d][%d] = 0x%%x\n", j, i);
fscanf(f, str, &conf.keys[j][i]);
}
}
fscanf(f, "log = %d\n", &conf.log);
fscanf(f, "options = %d\n", &conf.options);
fclose(f);
}
GtkWidget *MsgDlg;
void OnMsg_Ok() {
gtk_widget_destroy(MsgDlg);
gtk_main_quit();
}
void SysMessage(char *fmt, ...) {
GtkWidget *Ok,*Txt;
GtkWidget *Box,*Box1;
va_list list;
char msg[512];
va_start(list, fmt);
vsprintf(msg, fmt, list);
va_end(list);
if (msg[strlen(msg)-1] == '\n') msg[strlen(msg)-1] = 0;
MsgDlg = gtk_window_new (GTK_WINDOW_TOPLEVEL);
gtk_window_set_position(GTK_WINDOW(MsgDlg), GTK_WIN_POS_CENTER);
gtk_window_set_title(GTK_WINDOW(MsgDlg), "GSsoft Msg");
gtk_container_set_border_width(GTK_CONTAINER(MsgDlg), 5);
Box = gtk_vbox_new(5, 0);
gtk_container_add(GTK_CONTAINER(MsgDlg), Box);
gtk_widget_show(Box);
Txt = gtk_label_new(msg);
gtk_box_pack_start(GTK_BOX(Box), Txt, FALSE, FALSE, 5);
gtk_widget_show(Txt);
Box1 = gtk_hbutton_box_new();
gtk_box_pack_start(GTK_BOX(Box), Box1, FALSE, FALSE, 0);
gtk_widget_show(Box1);
Ok = gtk_button_new_with_label("Ok");
gtk_signal_connect (GTK_OBJECT(Ok), "clicked", GTK_SIGNAL_FUNC(OnMsg_Ok), NULL);
gtk_container_add(GTK_CONTAINER(Box1), Ok);
GTK_WIDGET_SET_FLAGS(Ok, GTK_CAN_DEFAULT);
gtk_widget_show(Ok);
gtk_widget_show(MsgDlg);
gtk_main();
}
s32 _PADopen(void *pDsp)
{
GSdsp = *(Display**)pDsp;
pthread_spin_init(&s_mutexStatus, PTHREAD_PROCESS_PRIVATE);
s_keyPress[0] = s_keyPress[1] = 0;
s_keyRelease[0] = s_keyRelease[1] = 0;
XAutoRepeatOff(GSdsp);
JoystickInfo::EnumerateJoysticks(s_vjoysticks);
return 0;
}
void _PADclose()
{
pthread_spin_destroy(&s_mutexStatus);
XAutoRepeatOn(GSdsp);
vector<JoystickInfo*>::iterator it;
FORIT(it, s_vjoysticks) delete *it;
s_vjoysticks.clear();
}
void _PADupdate(int pad)
{
pthread_spin_lock(&s_mutexStatus);
status[pad] |= s_keyRelease[pad];
status[pad] &= ~s_keyPress[pad];
s_keyRelease[pad] = 0;
s_keyPress[pad] = 0;
pthread_spin_unlock(&s_mutexStatus);
}
int _GetJoystickIdFromPAD(int pad)
{
// select the right joystick id
int joyid = -1;
for(int i = 0; i < PADKEYS; ++i) {
if( IS_JOYSTICK(conf.keys[pad][i]) || IS_JOYBUTTONS(conf.keys[pad][i]) ) {
joyid = PAD_GETJOYID(conf.keys[pad][i]);
break;
}
}
return joyid;
}
void CALLBACK PADupdate(int pad)
{
int i;
XEvent E;
int keyPress=0,keyRelease=0;
KeySym key;
// keyboard input
while (XPending(GSdsp) > 0) {
XNextEvent(GSdsp, &E);
switch (E.type) {
case KeyPress:
//_KeyPress(pad, XLookupKeysym((XKeyEvent *)&E, 0)); break;
key = XLookupKeysym((XKeyEvent *)&E, 0);
for (i=0; i<PADKEYS; i++) {
if (key == conf.keys[pad][i]) {
keyPress|=(1<<i);
keyRelease&=~(1<<i);
break;
}
}
event.event = KEYPRESS;
event.key = key;
break;
case KeyRelease:
key = XLookupKeysym((XKeyEvent *)&E, 0);
//_KeyRelease(pad, XLookupKeysym((XKeyEvent *)&E, 0));
for (i=0; i<PADKEYS; i++) {
if (key == conf.keys[pad][i]) {
keyPress&=~(1<<i);
keyRelease|= (1<<i);
break;
}
}
event.event = KEYRELEASE;
event.key = key;
break;
case FocusIn:
XAutoRepeatOff(GSdsp);
break;
case FocusOut:
XAutoRepeatOn(GSdsp);
break;
}
}
// joystick info
for(int i = 0; i < (int)s_vjoysticks.size(); ++i)
s_vjoysticks[i]->ProcessData();
pthread_spin_lock(&s_mutexStatus);
s_keyPress[pad] |= keyPress;
s_keyPress[pad] &= ~keyRelease;
s_keyRelease[pad] |= keyRelease;
s_keyRelease[pad] &= ~keyPress;
pthread_spin_unlock(&s_mutexStatus);
}
static GtkWidget *Conf=NULL, *s_devicecombo=NULL;
static int s_selectedpad = 0;
void UpdateConf(int pad)
{
s_selectedpad = pad;
int i;
GtkWidget *Btn;
for (i=0; i<ARRAYSIZE(s_pGuiKeyMap); i++) {
if( s_pGuiKeyMap[i] == NULL )
continue;
Btn = lookup_widget(Conf, GetLabelFromButton(s_pGuiKeyMap[i]).c_str());
if( Btn == NULL ) {
printf("ZeroPAD: cannot find key %s\n", s_pGuiKeyMap[i]);
continue;
}
string tmp;
if( IS_KEYBOARD(conf.keys[pad][i]) ) {
char* pstr = XKeysymToString(PAD_GETKEY(conf.keys[pad][i]));
if( pstr != NULL )
tmp = pstr;
}
else if( IS_JOYBUTTONS(conf.keys[pad][i]) ) {
tmp.resize(20);
sprintf(&tmp[0], "JBut %d", PAD_GETJOYBUTTON(conf.keys[pad][i]));
}
else if( IS_JOYSTICK(conf.keys[pad][i]) ) {
tmp.resize(20);
sprintf(&tmp[0], "JAxis %d", PAD_GETJOYSTICK_AXIS(conf.keys[pad][i]));
}
else if( IS_POV(conf.keys[pad][i]) ) {
tmp.resize(20);
sprintf(&tmp[0], "JPOV %d%s", PAD_GETJOYSTICK_AXIS(conf.keys[pad][i]), PAD_GETPOVSIGN(conf.keys[pad][i])?"-":"+");
}
if (tmp.size() > 0) {
gtk_entry_set_text(GTK_ENTRY(Btn), tmp.c_str());
}
else
gtk_entry_set_text(GTK_ENTRY(Btn), "Unknown");
gtk_object_set_user_data(GTK_OBJECT(Btn), (void*)(PADKEYS*pad+i));
}
// check bounds
int joyid = _GetJoystickIdFromPAD(pad);
if( joyid < 0 || joyid >= (int)s_vjoysticks.size() ) {
// get first unused joystick
for(joyid = 0; joyid < s_vjoysticks.size(); ++joyid) {
if( s_vjoysticks[joyid]->GetPAD() < 0 )
break;
}
}
if( joyid >= 0 && joyid < (int)s_vjoysticks.size() ) {
// select the combo
gtk_combo_box_set_active(GTK_COMBO_BOX(s_devicecombo), joyid);
}
else gtk_combo_box_set_active(GTK_COMBO_BOX(s_devicecombo), s_vjoysticks.size()); // no gamepad
int padopts = conf.options>>(16*pad);
gtk_toggle_button_set_state(GTK_TOGGLE_BUTTON(lookup_widget(Conf, "checkbutton_reverselx")), padopts&PADOPTION_REVERTLX);
gtk_toggle_button_set_state(GTK_TOGGLE_BUTTON(lookup_widget(Conf, "checkbutton_reversely")), padopts&PADOPTION_REVERTLY);
gtk_toggle_button_set_state(GTK_TOGGLE_BUTTON(lookup_widget(Conf, "checkbutton_reverserx")), padopts&PADOPTION_REVERTRX);
gtk_toggle_button_set_state(GTK_TOGGLE_BUTTON(lookup_widget(Conf, "checkbutton_reversery")), padopts&PADOPTION_REVERTRY);
gtk_toggle_button_set_state(GTK_TOGGLE_BUTTON(lookup_widget(Conf, "forcefeedback")), padopts&PADOPTION_FORCEFEEDBACK);
}
void OnConf_Key(GtkButton *button, gpointer user_data)
{
GdkEvent *ev;
GtkWidget* label = lookup_widget(Conf, GetLabelFromButton(gtk_button_get_label(button)).c_str());
if( label == NULL ) {
printf("couldn't find correct label\n");
return;
}
int id = (int)gtk_object_get_user_data(GTK_OBJECT(label));
int pad = id/PADKEYS;
int key = id%PADKEYS;
unsigned long *pkey = &conf.keys[pad][key];
vector<JoystickInfo*>::iterator it;
for (;;) {
ev = gdk_event_get();
if (ev != NULL) {
if (ev->type == GDK_KEY_PRESS) {
*pkey = ev->key.keyval;
char* tmp = XKeysymToString(*pkey);
if (tmp != NULL)
gtk_entry_set_text(GTK_ENTRY(label), tmp);
else
gtk_entry_set_text(GTK_ENTRY(label), "Unknown");
return;
}
}
#ifdef JOYSTICK_SUPPORT
FORIT(it, s_vjoysticks) {
if( (*it)->GetPAD() == s_selectedpad ) {
for(int i = 0; i < (*it)->GetNumButtons(); ++i) {
if( (*it)->GetButtonState(i) ) {
*pkey = PAD_JOYBUTTON((*it)->GetId(), i);
char str[32];
sprintf(str, "JBut %d", i);
gtk_entry_set_text(GTK_ENTRY(label), str);
return;
}
}
for(int i = 0; i < (*it)->GetNumAxes(); ++i) {
if( abs((*it)->GetAxisState(i)) > 0x3fff ) {
if( key < 16 ) { // POV
*pkey = PAD_POV((*it)->GetId(), (*it)->GetAxisState(i)<0, i);
char str[32];
sprintf(str, "JPOV %d%s", i, (*it)->GetAxisState(i)<0?"-":"+");
gtk_entry_set_text(GTK_ENTRY(label), str);
return;
}
else { // axis
*pkey = PAD_JOYSTICK((*it)->GetId(), i);
char str[32];
sprintf(str, "JAxis %d", i);
gtk_entry_set_text(GTK_ENTRY(label), str);
return;
}
}
}
}
}
#endif
}
}
void OnConf_Pad1(GtkButton *button, gpointer user_data)
{
if( gtk_toggle_button_get_active(GTK_TOGGLE_BUTTON(button)) )
UpdateConf(0);
}
void OnConf_Pad2(GtkButton *button, gpointer user_data)
{
if( gtk_toggle_button_get_active(GTK_TOGGLE_BUTTON(button)) )
UpdateConf(1);
}
void OnConf_Ok(GtkButton *button, gpointer user_data)
{
// conf.analog = gtk_toggle_button_get_active(GTK_TOGGLE_BUTTON(Analog));
SaveConfig();
gtk_widget_destroy(Conf);
gtk_main_quit();
}
void OnConf_Cancel(GtkButton *button, gpointer user_data)
{
gtk_widget_destroy(Conf);
gtk_main_quit();
LoadConfig(); // load previous config
}
void CALLBACK PADconfigure()
{
LoadConfig();
Conf = create_Conf();
// recreate
JoystickInfo::EnumerateJoysticks(s_vjoysticks);
s_devicecombo = lookup_widget(Conf, "joydevicescombo");
// fill the combo
char str[255];
vector<JoystickInfo*>::iterator it;
FORIT(it, s_vjoysticks) {
sprintf(str, "%d: %s - but: %d, axes: %d, ver: 0x%x", (*it)->GetId(), (*it)->GetName().c_str(),
(*it)->GetNumButtons(), (*it)->GetNumAxes(), (*it)->GetVersion());
gtk_combo_box_append_text (GTK_COMBO_BOX (s_devicecombo), str);
}
gtk_combo_box_append_text (GTK_COMBO_BOX (s_devicecombo), "No Gamepad");
UpdateConf(0);
gtk_widget_show_all(Conf);
gtk_main();
}
// GUI event handlers
void on_joydevicescombo_changed(GtkComboBox *combobox, gpointer user_data)
{
int joyid = gtk_combo_box_get_active(combobox);
// unassign every joystick with this pad
for(int i = 0; i < (int)s_vjoysticks.size(); ++i) {
if( s_vjoysticks[i]->GetPAD() == s_selectedpad )
s_vjoysticks[i]->Assign(-1);
}
if( joyid >= 0 && joyid < (int)s_vjoysticks.size() )
s_vjoysticks[joyid]->Assign(s_selectedpad);
}
void on_checkbutton_reverselx_toggled(GtkToggleButton *togglebutton, gpointer user_data)
{
int mask = PADOPTION_REVERTLX<<(16*s_selectedpad);
if( gtk_toggle_button_get_active(togglebutton) ) conf.options |= mask;
else conf.options &= ~mask;
}
void on_checkbutton_reversely_toggled(GtkToggleButton *togglebutton, gpointer user_data)
{
int mask = PADOPTION_REVERTLY<<(16*s_selectedpad);
if( gtk_toggle_button_get_active(togglebutton) ) conf.options |= mask;
else conf.options &= ~mask;
}
void on_checkbutton_reverserx_toggled(GtkToggleButton *togglebutton, gpointer user_data)
{
int mask = PADOPTION_REVERTRX<<(16*s_selectedpad);
if( gtk_toggle_button_get_active(togglebutton) ) conf.options |= mask;
else conf.options &= ~mask;
}
void on_checkbutton_reversery_toggled(GtkToggleButton *togglebutton, gpointer user_data)
{
int mask = PADOPTION_REVERTRY<<(16*s_selectedpad);
if( gtk_toggle_button_get_active(togglebutton) ) conf.options |= mask;
else conf.options &= ~mask;
}
void on_forcefeedback_toggled(GtkToggleButton *togglebutton, gpointer user_data)
{
int mask = PADOPTION_REVERTLX<<(16*s_selectedpad);
if( gtk_toggle_button_get_active(togglebutton) ) {
conf.options |= mask;
int joyid = gtk_combo_box_get_active(GTK_COMBO_BOX(s_devicecombo));
if( joyid >= 0 && joyid < (int)s_vjoysticks.size() )
s_vjoysticks[joyid]->TestForce();
}
else conf.options &= ~mask;
}
GtkWidget *About = NULL;
void OnAbout_Ok(GtkButton *button, gpointer user_data)
{
gtk_widget_destroy(About);
gtk_main_quit();
}
void CALLBACK PADabout() {
About = create_About();
gtk_widget_show_all(About);
gtk_main();
}
s32 CALLBACK PADtest() {
return 0;
}
//////////////////////////
// Joystick definitions //
//////////////////////////
// opens handles to all possible joysticks
void JoystickInfo::EnumerateJoysticks(vector<JoystickInfo*>& vjoysticks)
{
#ifdef JOYSTICK_SUPPORT
vector<JoystickInfo*>::iterator it;
FORIT(it, vjoysticks) delete *it;
vjoysticks.clear();
char devid[32];
JoystickInfo* pjoy = new JoystickInfo();
for(int i = 0; i < 6; ++i) {
sprintf(devid, "/dev/js%d", i);
if( pjoy->Init(devid, i) ) {
vjoysticks.push_back(pjoy);
pjoy = new JoystickInfo();
}
}
if( vjoysticks.size() == 0 ) {
// try from /dev/input/
for(int i = 0; i < 6; ++i) {
sprintf(devid, "/dev/input/js%d", i);
if( pjoy->Init(devid, i) ) {
vjoysticks.push_back(pjoy);
pjoy = new JoystickInfo();
}
}
}
delete pjoy;
// set the pads
for(int pad = 0; pad < 2; ++pad) {
// select the right joystick id
int joyid = -1;
for(int i = 0; i < PADKEYS; ++i) {
if( IS_JOYSTICK(conf.keys[pad][i]) || IS_JOYBUTTONS(conf.keys[pad][i]) ) {
joyid = PAD_GETJOYID(conf.keys[pad][i]);
break;
}
}
if( joyid >= 0 && joyid < (int)s_vjoysticks.size() )
s_vjoysticks[joyid]->Assign(pad);
}
#endif
}
JoystickInfo::JoystickInfo()
{
bTerminateThread = false;
js_fd = -1;
_id = -1;
pad = -1;
axisrange = 0x7fff;
}
void JoystickInfo::Destroy()
{
#ifdef JOYSTICK_SUPPORT
if( js_fd >= 0 ) {
bTerminateThread = true;
void* ret;
pthread_join(pthreadpoll, &ret);
close(js_fd);
js_fd = -1;
}
#endif
}
bool JoystickInfo::Init(const char* pdevid, int id, bool bStartThread)
{
#ifdef JOYSTICK_SUPPORT
assert(pdevid != NULL );
Destroy();
if ((js_fd = open(pdevid, O_RDWR)) < 0) {
js_fd = -1;
return false;
}
char name[256];
ioctl(js_fd, JSIOCGVERSION, &version);
if (version < 0x010000) {
printf("joystick driver version is too old (%d)\n",version);
return false;
}
char numaxes, numbuttons;
ioctl(js_fd, JSIOCGAXES, &numaxes);
ioctl(js_fd, JSIOCGBUTTONS, &numbuttons);
ioctl(js_fd, JSIOCGNAME(256), name);
// set to non-blocking
int flags;
if (-1 == (flags = fcntl(js_fd, F_GETFL, 0)))
flags = 0;
if( fcntl(js_fd, F_SETFL, flags | O_NONBLOCK) < 0 ) {
printf("fcntl error\n");
return false;
}
if( numaxes >= 0 ) vaxes.resize(numaxes);
if( numbuttons >= 0 ) vbuttonstate.resize(numbuttons);
devid = pdevid;
devname = name;
_id = id;
if( bStartThread ) {
// create thread
if( pthread_create(&pthreadpoll, NULL, pollthread, this) ) {
printf("failed to create thread\n");
close(js_fd); js_fd = -1;
return false;
}
}
return true;
#else
return false;
#endif
}
void JoystickInfo::ProcessData()
{
if( pad < 0 || js_fd < 0 )
return;
for (int i=0; i<PADKEYS; i++) {
int key = conf.keys[pad][i];
if (IS_JOYBUTTONS(key) && PAD_GETJOYID(key) == _id) {
if( vbuttonstate[PAD_GETJOYBUTTON(key)] )
status[pad] &= ~(1<<i); // pressed
else
status[pad] |= (1<<i);
}
if (IS_JOYSTICK(key) && PAD_GETJOYID(key) == _id) {
switch(i) {
case PAD_LX:
g_lanalog[pad].x = vaxes[PAD_GETJOYSTICK_AXIS(key)]/256;
if( conf.options&PADOPTION_REVERTLX )
g_lanalog[pad].x = -g_lanalog[pad].x;
g_lanalog[pad].x += 128;
break;
case PAD_LY:
g_lanalog[pad].y = vaxes[PAD_GETJOYSTICK_AXIS(key)]/256;
if( conf.options&PADOPTION_REVERTLY )
g_lanalog[pad].y = -g_lanalog[pad].y;
g_lanalog[pad].y += 128;
break;
case PAD_RX:
g_ranalog[pad].x = vaxes[PAD_GETJOYSTICK_AXIS(key)]/256;
if( conf.options&PADOPTION_REVERTRX )
g_ranalog[pad].x = -g_ranalog[pad].x;
g_ranalog[pad].x += 128;
break;
case PAD_RY:
g_ranalog[pad].y = vaxes[PAD_GETJOYSTICK_AXIS(key)]/256;
if( conf.options&PADOPTION_REVERTRY )
g_ranalog[pad].y = -g_ranalog[pad].y;
g_ranalog[pad].y += 128;
break;
}
}
if( IS_POV(key) && PAD_GETJOYID(key) == _id) {
if( PAD_GETPOVSIGN(key) && (vaxes[PAD_GETJOYSTICK_AXIS(key)]<-2048) )
status[pad] &= ~(1<<i);
else if( !PAD_GETPOVSIGN(key) && (vaxes[PAD_GETJOYSTICK_AXIS(key)]>2048) )
status[pad] &= ~(1<<i);
else
status[pad] |= (1<<i);
}
}
}
// assigns a joystick to a pad
void JoystickInfo::Assign(int newpad)
{
if( pad == newpad )
return;
pad = newpad;
if( pad >= 0 ) {
for(int i = 0; i < PADKEYS; ++i) {
if( IS_JOYBUTTONS(conf.keys[pad][i]) ) {
conf.keys[pad][i] = PAD_JOYBUTTON(_id, PAD_GETJOYBUTTON(conf.keys[pad][i]));
}
else if( IS_JOYSTICK(conf.keys[pad][i]) ) {
conf.keys[pad][i] = PAD_JOYSTICK(_id, PAD_GETJOYBUTTON(conf.keys[pad][i]));
}
}
}
}
void JoystickInfo::TestForce()
{
#ifdef JOYSTICK_SUPPORT
// send a small force command
//struct input_event play;
// struct input_event stop;
// struct ff_effect effect;
// int fd, ret;
//
// fd = open("/dev/input/js0", O_RDWR);
// //fd = js_fd;
//
// int features;
// ret = ioctl(fd, EVIOCGBIT(EV_FF, sizeof(unsigned long)), &features);
// printf("ret: %d, err: %d\n", ret, errno);
// printf("features: %x\n", features);
//
// memset(&effect, 0, sizeof(effect));
// effect.type = FF_RUMBLE;
// effect.id = 1;
// effect.u.rumble.weak_magnitude = 0x3fff;
// effect.u.rumble.strong_magnitude = 0x3fff;
//
// ret = ioctl(fd, EVIOCSFF, &effect);
// printf("ret: %d, err: %d\n", ret, errno);
//
// /* Play three times */
// play.type = EV_FF;
// play.code = effect.id;
// play.value = 3;
//
// ret = write(fd, (const void*) &play, sizeof(play));
// printf("ret: %d, err: %d\n", ret, errno);
/* Stop an effect */
// stop.type = EV_FF;
// stop.code = FF_RUMBLE;
// stop.value = 0;
//
// write(fd, (const void*) &play, sizeof(stop));
// close(fd);
#endif
}
#ifdef JOYSTICK_SUPPORT
void* JoystickInfo::pollthread(void* p)
{
return ((JoystickInfo*)p)->_pollthread();
}
void* JoystickInfo::_pollthread()
{
int ret;
js_event js;
while(!bTerminateThread) {
usleep(5000); // 10ms
if( js_fd < 0 ) {
// try to recreate
if( Init(devid.c_str(), _id, false) ) {
printf("ZeroPAD: recreating joystick \"%s\"\n", devname.c_str());
}
else continue;
}
if ( (ret=read(js_fd, &js, sizeof(struct js_event))) != sizeof(struct js_event)) {
if( errno == EBADF || errno == ENODEV ) {
// close and recreate
close(js_fd); js_fd = -1;
}
else if( errno != EINTR && errno != EAGAIN ) {
printf("error in reading joystick data: %d\n", errno);
}
continue;
}
// ignore the startup events?
if( js.type & JS_EVENT_INIT ) {
continue;
}
if ((js.type & ~JS_EVENT_INIT) == JS_EVENT_BUTTON)
vbuttonstate[js.number] = js.value;
if( js.type == JS_EVENT_AXIS )
vaxes[js.number] = js.value;
}
return NULL;
}
#endif