#include <Joystick.h>
// コンパイルオプション
#define __Debug 0 // 1:シリアルデバッグON
#define __IF_SEGA 1 // 1:SEGA純正パッドを模擬する、0:サードパーティ製を模擬する
#define __BugFix 1 //メガドライブミニに接続時に方向キーが入りっぱなしになる場合に1にする
#define DELAY_TIME 10 // 遅延時間（６μs）<--5より小さくするとPSX動作がNG
#define SCAN_TIME 10 // パッド読み取りスキャン時間（10ms） <-- 7だと100回/秒程度。2以下(200回以上/秒)はお勧めできない
//PSXコントローラー制御ピン定義
#define PS_DATA 7 // データ信号
#define PS_CMD 8 // Command送信
#define PS_ATT 9 // セレクト信号
#define PS_CLK 10 // 制御クロック信号
// PSX送受信コマンド種別
enum{
PS_READ = 0 , // パッド状態読出し(READ_DATA)
PS_CONFIG_MODE , // コンフィグモード遷移(CONFIG_MODE_ENTER)
PS_CONFIG_EXIT , // コンフィグモード終了(CONFIG_MODE_EXIT)
PS_SET_MODE , // 動作モード／モード変更可否設定(SET_MODE_AND_LOCK)
PS_QUERY , // 機器種別/動作モード取得(QUERY_MODEL_AND_MODE)
PS_VIBRATION_ENABLE , // 振動モード許可(VIBRATION_ENABLE)
PS_CMD_MAX
};
#define PS_ID_MAX 2 // PSXコマンドID長(2バイト)
#define PS_DATA_MAX 30 // PSXコマンドデータ最大長(30バイト以下)
typedef struct Psxid {
byte id; // 接続機器ID
byte config; // 初期化要求フラグ(0x5a=通常、0=再初期化あり)
} PSXID;
// PSX送信コマンドテーブル
const byte ps_cmd[PS_CMD_MAX][PS_ID_MAX] =
{
// PLAYSTATION Command table
{ 0x42 ,0x00 }, // パッド状態読出し(READ_DATA)
{ 0x43 ,0x00 }, // コンフィグモード遷移(CONFIG_MODE_ENTER)
{ 0x43 ,0x00 }, // コンフィグモード終了(CONFIG_MODE_EXIT)
{ 0x44 ,0x00 }, // 動作モード／モード変更可否設定(SET_MODE_AND_LOCK)
{ 0x45 ,0x00 }, // 機器種別/動作モード取得(QUERY_MODEL_AND_MODE)
{ 0x4D ,0x00 } // 振動モード許可(VIBRATION_ENABLE)
};
// メガドライブパッド用ピン番号
#define MD_D0 3 // PD0/Pin3
#define MD_D1 2 // PD1/Pin2
#define MD_D2 1 // PD2/Pin1(RX1)
#define MD_D3 0 // PD3/Pin0(TX1)
#define MD_D4 4 // PD4/Pin4
#define MD_D5 6 // PD7/Pin6
#define MD_SEL 5 // Select信号ポート番号
// PCEコントローラ制御ピン定義
#define PC_D0 18 // PD0/Pin18
#define PC_D1 19 // PD1/Pin19
#define PC_D2 20 // PD2/Pin20
#define PC_D3 21 // PD3/Pin21
#define PC_SEL 15 // Select信号
#define PC_EN 14 // /Enable信号
//Super Famicom コントローラ制御ピン定義
#define SF_CLOCK 8 // PB4/Pin8
#define SF_LATCH 10 // PB6/Pin10
#define SF_DATA 16 // PB2/Pin16
#if __BugFix
// 方向キー移動量(MEGA DRIVE mini向け)
#define AXIS_MIN 0 // アナログ方向キー最小値
#define AXIS_MAX 511 // アナログ方向キー最大値
#define AXIS_CENTER 255 // アナログ方向キーセンター位置
#else
// 方向キー移動量(PC向け)
#define AXIS_MIN 0 // アナログ方向キー最小値
#define AXIS_MAX 255 // アナログ方向キー最大値
#define AXIS_CENTER 127 // アナログ方向キーセンター位置
#endif
// Joystick PAD番号定義
#if __IF_SEGA
//SEGA 純正パッド模擬(VID=0x0CA3、PID=0x0024)
#define PAD_Y 0 // Yボタン
#define PAD_B 1 // Bボタン
#define PAD_A 2 // Aボタン
#define PAD_X 3 // Xボタン
#define PAD_Z 4 // Zボタン
#define PAD_C 5 // Cボタン
#define PAD_MODE 8 // MODEボタン
#define PAD_START 9 // STARTボタン
#else
//DragonRise製パッド模擬(VID=0x0079、PID=0x0011)
#define PAD_X 0 // Xボタン
#define PAD_A 1 // Aボタン
#define PAD_B 2 // Bボタン
#define PAD_Y 3 // Yボタン
#define PAD_C 4 // Cボタン
#define PAD_Z 5 // Zボタン
#define PAD_MODE 8 // MODEボタン
#define PAD_START 9 // STARTボタン
#endif
// 接続パッド種別
enum{
tMD = 0 , // MegaDrive PAD
tPSX , // Play Station PAD
tPCE , // PC Engine/TG16 PAD
tSFC , // Super Famicom/Super Nintendo Entertainment System PAD
tMAX
};
// パッドボタン定義（ここに定義されたタイプのみ有効）
enum{
pUP = 0 , // UP
pDOWN , // DOWN
pLEFT , // LEFT
pRIGHT , // RIGHT
pA , // A
pB , // B
pC , // C
pSTART , // START
pMODE , // MODE
pX , // X
pY , // Y
pZ , // Z
pSEL , // SELECT(PSX/PCE)
pIII , // III(PCE 6B)
pMAX
};
// 機種別ボタンチェック値(該当Bit位置をマスクする値)
const unsigned int pad_mask[tMAX][pMAX] =
{
// UP ,DOWN ,LEFT ,RIGHT ,A ,B ,C ,START ,MODE ,X ,Y ,Z ,SELECT ,III
{ 0x0001 ,0x0002 ,0x0004 ,0x0008 ,0x0040 ,0x0010 ,0x0020 ,0x0080 ,0x0800 ,0x0400 ,0x0200 ,0x0100 ,0x0000 ,0x0000 },//MEGA DRIVE(tMD)
{ 0x0010 ,0x0040 ,0x0080 ,0x0020 ,0x4000 ,0x2000 ,0x0800 ,0x0008 ,0x0001 ,0x8000 ,0x1000 ,0x0400 ,0x0001 ,0x0000 },//PLAY STATION(tPSX)
{ 0x0001 ,0x0004 ,0x0008 ,0x0002 ,0x0040 ,0x0020 ,0x0010 ,0x0080 ,0x0040 ,0x0200 ,0x0400 ,0x0800 ,0x0040 ,0x0100 },//PC ENGINE/TG16(tPCE)
{ 0x0010 ,0x0020 ,0x0040 ,0x0080 ,0x0001 ,0x0100 ,0x0800 ,0x0008 ,0x0004 ,0x0002 ,0x0200 ,0x0400 ,0x0000 ,0x0000 } //Super Famicom/SNES(tSFC)
};
// パッドボタン定義とJoystickライブラリ送信値変換用
const int pad_map[pMAX] =
{ -1,-1,-1,-1,PAD_A,PAD_B,PAD_C,PAD_START,PAD_MODE,PAD_X,PAD_Y,PAD_Z,PAD_MODE,PAD_A};
//PAD状態を前回と最新状態で比較して、変化があった場合にコードを送信する
unsigned int cur_sts[tMAX]; // 前回のボタン状態を保持する
// Joystickライブラリ定義
Joystick_ Joystick(JOYSTICK_DEFAULT_REPORT_ID,JOYSTICK_TYPE_JOYSTICK,
10, 0, // Button Count, Hat Switch Count
true, true, false, // X, Y, and Z Axis
false, false, false, // Rx, but no Ry or Rz
false, false, // No rudder or throttle
false, false, false); // No accelerator, brake, or steering
PSXID psx_id; // PSX機種ID情報
byte psx_data[20];
bool psx_config_flag = false;
byte psx_mode; // 0:デジタル、1:アナログ、2ジョグコン、3:デュアルショック
byte psx_motor[2]; // psx_motor[0]=小モーター(0:停止、1:回転)、psx_motor[1]大モーター(0:停止、1～255値)
Gains mygains[2]; // GAIN data for Force Feedback
int32_t forces[2]; // Force Feedback data
EffectParams myeffectparams[2];
#if __Debug
///////////////////////////////////////////////////////////////////////////////
void disp_psx(void)
{
Serial.print("ID:0x");
Serial.print(psx_id.id,HEX);
Serial.print(" 0x");
Serial.print(psx_id.config,HEX);
int len = (psx_id.id&0xf)<<1;
len=(len == 0xf) ? 2 : len;
for ( int i=0; i<len ;i++)
{
Serial.print(" 0x");
Serial.print(psx_data[i],HEX);
}
Serial.print("\n");
}
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
/////////////////////////////////////////////////
// プレイステーションパッド送受信処理
// 入力： cmd :送付コマンド値
// 戻り： true=読出し正常、false=失敗（未接続など）
/////////////////////////////////////////////////
byte ps_trx(int cmd)
{
byte data = 0;
// 8Bit送受信処理
for (int i = 0 ; i < 8 ; i++ )
{
//コマンド出力(1bit)
digitalWrite(PS_CMD,(cmd &(1<<i)) ? HIGH : LOW );
// Clock信号 LOW出力
digitalWrite(PS_CLK, LOW);
//4μs以上待つ
delayMicroseconds(DELAY_TIME);
//データ読出し(1bit)
data |= digitalRead(PS_DATA)<<i;
// Clock信号 HIGH出力
digitalWrite(PS_CLK, HIGH);
//4μs以上待つ
delayMicroseconds(DELAY_TIME);
}
return data;
}
/////////////////////////////////////////////////
// プレイステーションパッド送受信
// 入力： type :コマンド種別(PS_READ 他）
// 出力構造体：PSXID psx_id、psx_data[]
// 戻り： true=正常、false=失敗
/////////////////////////////////////////////////
bool psx_cmd(int type)
{
byte send[PS_DATA_MAX];
bool sts = false;
//送信データ初期化
memset(send,0,PS_DATA_MAX);
//送信データ編集
switch(type)
{
case PS_READ:
//振動（デュアルショック）モード時
if( psx_mode == 3 )
{
send[0]=psx_motor[0];//小モーターON(1)/OFF(0)
send[1]=psx_motor[1];//大モーターON(値)/OFF(0)
}
break;
case PS_CONFIG_MODE:
send[0]=0x01;
break;
case PS_VIBRATION_ENABLE:
send[1]=0x01;
send[2]=0xff;
send[3]=0xff;
send[4]=0xff;
send[5]=0xff;
break;
default:
break;
}
//デバイス選択
digitalWrite(PS_ATT, LOW);
//コマンド送付
ps_trx(0x01);
psx_id.id = ps_trx(ps_cmd[type][0]);
psx_id.config = ps_trx(ps_cmd[type][1]);
// 受信IDが読めている場合(=0xff以外なら)、パッド状態を読み出す
if ( psx_id.id != 0xff )
{
//データ長取り出し
int data_len = (psx_id.id & 0xf)<<1;
//パッド状態データ読出し
for (int i = 0 ; i < data_len ; i++ )
{
psx_data[i]= ps_trx(send[i]);
}
//モード状態変更検知
if ( psx_id.config == 0 )
{
//パッド未初期化とする
psx_config_flag = false;
}
// アナログ→デジタル変化検知（アナログモードでデジタルパッドを検知した）
if (( psx_mode>0 ) && ( type==PS_READ ) && ( psx_id.id==0x41 ))
{
//パッド未初期化とする
psx_config_flag = false;
}
//正常完了
sts = true;
}
else
{
//パッド未初期化とする
psx_config_flag = false;
}
//デバイスアクセス終了
digitalWrite(PS_ATT, HIGH);
delayMicroseconds(DELAY_TIME);
#if __Debug
///////////////////////////////////////////////////////////////////////////////
if(type!=PS_READ)
{
Serial.print("MODE");
Serial.print(psx_mode,HEX);
Serial.print(":CMD(");
Serial.print(type,DEC);
Serial.print(")0x");
Serial.print(ps_cmd[type][0],HEX);
Serial.print(" ");
disp_psx();
}
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
return sts;
}
/////////////////////////////////////////////////
// プレイステーションパッド初期化
// 入力
// type :機種種別(tMD、tPSX、tPCE）
// state = 方向キー状態
// 戻り
// true=ボタン状態変化あり、false=変化なし
/////////////////////////////////////////////////
bool psx_config(void)
{
bool sts;
//デジタルモードとする（初期値）
psx_mode = 0;
//コンフィグモード遷移(CONFIG_MODE_ENTER)
if (sts = psx_cmd(PS_CONFIG_MODE))
{
//コマンド受理待ち
delay(1);
// 機器種別/動作モード取得(QUERY_MODEL_AND_MODE)
sts |= psx_cmd(PS_QUERY);
delay(1);
// アナログモードである
if((psx_id.id==0xf3)&&(psx_data[2]==0x01))
{
//アナログモード設定
psx_mode = 1;
//デュアルショックまたは、ジョグコンである
if((psx_data[3]==0x01)||(psx_data[3]==0x02))
{
//ジョグコン・デュアルショックモード設定
psx_mode += psx_data[3];
// デュアルショック
if (psx_data[3]==0x02)
{
// 振動モード許可
sts |= psx_cmd(PS_VIBRATION_ENABLE);
delay(1);
}
}
}
// コンフィグモード終了(CONFIG_MODE_EXIT))
sts |= psx_cmd(PS_CONFIG_EXIT);
}
return sts;
}
/////////////////////////////////////////////////
// 方向キー制御処理（機種共通）
// 入力
// type :機種種別(tMD、tPSX、tPCE）
// state = 方向キー状態
// 戻り
// true=ボタン状態変化あり、false=変化なし
/////////////////////////////////////////////////
bool set_axis(int type ,unsigned int state )
{
int axis = AXIS_CENTER;
bool change = false;
///////////////////
// Y軸制御
///////////////////
// 上下キー状態チェック用マスク値取得
unsigned int mask = pad_mask[type][pUP]|pad_mask[type][pDOWN];
//上下キー状態変化あり
if (( cur_sts[type] & mask )!=( state & mask ))
{
change = true;
// 上キーを離している
if (state & pad_mask[type][pUP])
{
// 下キーを離している
if (state & pad_mask[type][pDOWN])
{
// Y軸をセンターに戻す
axis = AXIS_CENTER;
psx_motor[1]=0;
}
else
{
// 下キーを押下している
// Y軸を最大
axis = AXIS_MAX;
}
}
// 上キーを押下している
else
{
// Y軸を最小
axis = AXIS_MIN;
psx_motor[1]=128;
}
// Y軸値セット
Joystick.setYAxis(axis);
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("Joystick.setYAxis(");
Serial.print(axis,DEC);
Serial.print(")\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
// 方向キー状態を最新に変更
cur_sts[type] = (cur_sts[type] & ~mask)|(state & mask);
}
///////////////////
// X軸制御
///////////////////
// 左右キー状態チェック用マスク値取得
mask = pad_mask[type][pLEFT]|pad_mask[type][pRIGHT];
// 左右キー状態変化あり
if (( cur_sts[type] & mask )!=( state & mask ))
{
change = true;
// 左キーを離している
if (state & pad_mask[type][pLEFT])
{
// 右キーを離している
if (state & pad_mask[type][pRIGHT])
{
// X軸をセンターに戻す
axis = AXIS_CENTER;
psx_motor[0]=0;
}
// 右キーを押下している
else
{
// X軸を最大
axis = AXIS_MAX;
}
}
// 左キーを押下している
else
{
// X軸を最小
axis = AXIS_MIN;
psx_motor[0]=1;
}
// X軸値セット
Joystick.setXAxis(axis);
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("Joystick.setXAxis(");
Serial.print(axis,DEC);
Serial.print(")\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
// 方向キー状態を最新に変更
cur_sts[type] = (cur_sts[type] & ~mask)|(state & mask);
}
// 方向キー状態を最新に変更
// cur_sts[type] = (cur_sts[type] & 0xfff0)|(state & 0xf);
return change;
}
/////////////////////////////////////////////////
// パッド制御処理（機種共通）
// 入力
// type :機種種別(tMD、tPSX、tPCE）
// state = 方向キー状態
// button = ボタン定義
// 戻り
// true=ボタン状態変化あり、false=変化なし
/////////////////////////////////////////////////
bool set_button(int type ,unsigned int state ,int button )
{
// ボタン状態チェック用マスク値取得
unsigned int mask = pad_mask[type][button];
// ボタン状態変化あり
if (( cur_sts[type] & mask )!=( state & mask ))
{
// Joystickボタン値取得
int pad = pad_map[button];
// ボタン押下？
if( !(state & mask) )
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print(pad,DEC);
Serial.print(" Press\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
// ボタン押下セット
Joystick.pressButton(pad);
}
// 離した
else
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print(pad,DEC);
Serial.print(" Release\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
// ボタン離す
Joystick.releaseButton(pad);
}
// ボタン状態を変更する
cur_sts[type] = (cur_sts[type] & ~mask)|(state & mask);
// 変化あり
return true;
}
// 変化なし
return false;
}
//////////////////////////////////////
// 初期化
//////////////////////////////////////
void setup() {
// put your setup code here, to run once:
// メガドライブパッド読み取り用ポート初期化(INPUT_PULLUP)
pinMode(MD_D0, INPUT_PULLUP);
pinMode(MD_D1, INPUT_PULLUP);
pinMode(MD_D2, INPUT_PULLUP);
pinMode(MD_D3, INPUT_PULLUP);
pinMode(MD_D4, INPUT_PULLUP);
pinMode(MD_D5, INPUT_PULLUP);
// MD Select信号出力用ポート初期化(OUTPUT)
pinMode(MD_SEL, OUTPUT);
//プレイステーション制御用I/O初期化
//DATA信号初期化
pinMode(PS_DATA, INPUT_PULLUP);
//CMD信号初期化
pinMode(PS_CMD, OUTPUT);
//ATT信号初期化(HIGH=非選択状態)
pinMode(PS_ATT, OUTPUT);
digitalWrite(PS_ATT, HIGH);
//Clock信号初期化(HIGH=初期値)
pinMode(PS_CLK, OUTPUT);
digitalWrite(PS_CLK, HIGH);
// PCEパッド読み取り用ポート初期化(INPUT_PULLUP)
pinMode(PC_D0, INPUT_PULLUP);
pinMode(PC_D1, INPUT_PULLUP);
pinMode(PC_D2, INPUT_PULLUP);
pinMode(PC_D3, INPUT_PULLUP);
// PCE SEL信号出力用ポート初期化(OUTPUT)
pinMode(PC_SEL, OUTPUT);
// PCE /EN信号出力用ポート初期化(OUTPUT:HIGH)
pinMode(PC_EN, OUTPUT);
// /EN=HIGH（パッド無効）セット
digitalWrite(PC_EN, HIGH);
//SFC制御クロック信号初期化(OUTPUT:HIGH)
pinMode(SF_CLOCK, OUTPUT);
digitalWrite(SF_CLOCK, HIGH);
//SFC制御ラッチ信号初期化(OUTPUT:LOW)
pinMode(SF_LATCH, OUTPUT);
digitalWrite(SF_LATCH, LOW);
//SFC制御データ信号初期化(INPUT_PULLUP)
pinMode(SF_DATA, INPUT_PULLUP);
// Joystick Library初期化
Joystick.begin(false);
// PAD方向キー初期化
Joystick.setXAxisRange(AXIS_MIN, AXIS_MAX);
Joystick.setYAxisRange(AXIS_MIN, AXIS_MAX);
Joystick.setXAxis(AXIS_CENTER);
Joystick.setYAxis(AXIS_CENTER);
// パッド状態初期化
cur_sts[tMD] = 0xffff;
cur_sts[tPSX]= 0xffff;
cur_sts[tPCE]= 0xffff;
cur_sts[tSFC]= 0xffff;
//set X Axis gains
mygains[0].totalGain = 50;
mygains[0].constantGain = 50;
mygains[0].rampGain = 50;
mygains[0].sineGain = 50;
//set Y Axis gains
mygains[1].totalGain = 50;
mygains[1].constantGain = 50;
mygains[1].rampGain = 50;
mygains[1].sineGain = 50;
Joystick.setGains(mygains);
#if __Debug
Serial.begin(38400);
#endif //__Debug
}
//////////////////////////////////////
// メインループ
//////////////////////////////////////
void loop() {
// put your main code here, to run repeatedly:
unsigned int cur_state = 0;
/////////////////////////////////
// MEGA DRIVE パッド状態読み出し
/////////////////////////////////
bool Pad6B = LOW; //6Bパッド未検出
unsigned int state = 0xffff;
int sel = 0;
// PAD情報取得(読取りシーケンス7回実行)
for( int i = 0 ; i < 7 ; i++ )
{
// Select信号出力
digitalWrite(MD_SEL, !sel ? LOW : HIGH );
delayMicroseconds(DELAY_TIME);
// パッド状態読み出し
cur_state = PIND;
// 6Bパッド検出？
if ( !sel && !(cur_state & 0xf) )
{
// 6Bパッド検出セット
Pad6B = HIGH;
}
// 6Bパッド未検出
if(Pad6B == LOW)
{
// パッド情報(3B/6B共通)を格納する
if (sel)
state = (state & 0xfc0)|((cur_state & 0x1f)|(cur_state & 0x80)>>2);
else
state = (state & 0xf3f)|(((cur_state & 0x10)<<2)|(cur_state & 0x80));
}
else
{
if (sel)
// 6Bパッド情報を格納する
state = (state & 0xf0ff)|((cur_state & 0xf)<<8);
}
// Select状態(Low/High)を反転する
sel ^= 0x01;
}
////////////////////////////////
// Joystick制御
////////////////////////////////
bool change = false;
//方向キー制御
change |= set_axis(tMD,state);
// 各ボタン制御
change |= set_button(tMD,state,pA);
change |= set_button(tMD,state,pB);
change |= set_button(tMD,state,pC);
change |= set_button(tMD,state,pSTART);
// 6Bパッド検出
if(Pad6B)
{
change |= set_button(tMD,state,pMODE);
change |= set_button(tMD,state,pX);
change |= set_button(tMD,state,pY);
change |= set_button(tMD,state,pZ);
}
// Joystick情報送信
if(change)
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("MD :");
Serial.print(state,BIN);
Serial.print("\n");
Serial.print("Joystick.sendState()\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
Joystick.sendState();
}
////////////////////////////////////////////
//プレステコントローラ状態読み出し
////////////////////////////////////////////
state = 0xffff;
change = false;
//パッド状態読み出し
if (psx_cmd(PS_READ) == true)
{
//ボタン状態読み出し
state = (psx_data[1]<<8)|psx_data[0];
//パッド未初期化？
if (psx_config_flag == false)
{
//パッド初期化
psx_config_flag = psx_config();
}
//set X Axis Spring Effect Param
myeffectparams[0].springMaxPosition = 1024;
myeffectparams[0].springPosition = 127;
myeffectparams[0].damperMaxVelocity = 1024;
myeffectparams[0].damperVelocity = 127;
myeffectparams[0].inertiaMaxAcceleration = 1024;
myeffectparams[0].inertiaAcceleration = 127;
myeffectparams[0].frictionMaxPositionChange = 1024;
myeffectparams[0].frictionPositionChange = 127;
//set Y Axis Spring Effect Param
myeffectparams[1].springMaxPosition = 1024;
myeffectparams[1].springPosition = 127;
myeffectparams[1].damperMaxVelocity = 1024;
myeffectparams[1].damperVelocity = 127;
myeffectparams[1].inertiaMaxAcceleration = 1024;
myeffectparams[1].inertiaAcceleration = 127;
myeffectparams[1].frictionMaxPositionChange = 1024;
myeffectparams[1].frictionPositionChange = 127;
Joystick.setEffectParams(myeffectparams);
Joystick.getForce(forces);
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("forces[0]=");
Serial.print(forces[0],BIN);
Serial.print(" forces[1]=");
Serial.print(forces[1],BIN);
Serial.print("\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
}
//方向キー制御
change |= set_axis(tPSX,state);
// 各ボタン制御
change |= set_button(tPSX,state,pA);
change |= set_button(tPSX,state,pB);
change |= set_button(tPSX,state,pC);
change |= set_button(tPSX,state,pSTART);
change |= set_button(tPSX,state,pMODE);
change |= set_button(tPSX,state,pX);
change |= set_button(tPSX,state,pY);
change |= set_button(tPSX,state,pZ);
// SELECTボタンをMODEボタンに割当
change |= set_button(tPSX,state,pSEL);
// Joystick情報送信
if(change)
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("PSX :");
Serial.print(state,BIN);
Serial.print("\n");
disp_psx();
Serial.print("Joystick.sendState()\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
Joystick.sendState();
}
////////////////////////////////////////////
//PCEコントローラ状態読み出し
////////////////////////////////////////////
state = 0xffff;
// 6Bパッド未検出
Pad6B = LOW;
// 6ボタン対応PAD情報取得(読み取りシーケンスを２回実施)
for( int i = 0 ; i < 2 ; i++ )
{
//6B検出フラグ初期化（シーケンス毎にクリア）
bool detect6b = LOW;
// 読出しシーケンス開始(/EN=L)
digitalWrite(PC_EN, LOW );
// SEL=Hi
digitalWrite(PC_SEL, HIGH );
delayMicroseconds(DELAY_TIME);
//パッド情報読出し（方向キーが入る）
unsigned int cur_state = PINF & 0xf0;
//6ボタンPAD検出(D0～D3全てLOW)？
if (!cur_state)
{
// 6ボタンPAD検出セット（パッド情報は保存しない）
detect6b = HIGH;
Pad6B = HIGH;
}
else
{
//方向キー状態を格納
state = (state & 0xff0)|(cur_state>>4);
}
//SEL=LOW
digitalWrite(PC_SEL, LOW );
delayMicroseconds(DELAY_TIME);
//パッド情報読出し（ボタン情報が入る）
cur_state = PINF & 0xf0;
//シーケンスHiで6Bパッド検出
if( detect6b )
{
// 6ボタン状態を格納
state = (state & 0x0ff)|(cur_state<<4);
}
else
{
// 標準ボタン状態をに格納
state = (state & 0xf0f)|cur_state;
}
// 読出しシーケンス終了(/EN=H)
digitalWrite(PC_EN, HIGH );
}
change = false;
//方向キー制御
change |= set_axis(tPCE,state);
// 各ボタン制御
change |= set_button(tPCE,state,pB);
change |= set_button(tPCE,state,pC);
change |= set_button(tPCE,state,pSTART);
// 6Bパッド未検出
if(!Pad6B)
{
// 3BパッドはSELECTをAボタン指定
change |= set_button(tPCE,state,pA);
}
else
{
// 6Bパッドボタン指定
change |= set_button(tPCE,state,pX);
change |= set_button(tPCE,state,pY);
change |= set_button(tPCE,state,pZ);
// 6BパッドはIIIをAボタンに割当
change |= set_button(tPCE,state,pIII);
// 6BパッドはSELECTボタンをMODEボタンに割当
change |= set_button(tPCE,state,pSEL);
}
// Joystick情報送信
if(change)
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("PCE :");
Serial.print(state,BIN);
Serial.print("\n");
Serial.print("Joystick.sendState()\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
Joystick.sendState();
}
////////////////////////////////////////////
//SUPER FAMICOMコントローラ状態読み出し
////////////////////////////////////////////
state = 0;
// LATCH信号HIGH出力
digitalWrite(SF_LATCH, HIGH);
delayMicroseconds(DELAY_TIME*2);
// 12μ秒後、LATCH信号LOWに戻す
digitalWrite(SF_LATCH, LOW);
delayMicroseconds(DELAY_TIME);
// ボタン状態読出し(16Bit)
for(int i = 0; i < 16; i++)
{
// CLOCK信号LOW出力
digitalWrite(SF_CLOCK, LOW);
delayMicroseconds(DELAY_TIME);
// ボタン状態を(1Bitづつ)読み出す
state |= digitalRead(SF_DATA) << i;
// CLOCK信号をHIGHに戻す
digitalWrite(SF_CLOCK, HIGH);
delayMicroseconds(DELAY_TIME);
}
change = false;
//方向キー制御
change |= set_axis(tSFC,state);
// 各ボタン制御
change |= set_button(tSFC,state,pA);
change |= set_button(tSFC,state,pB);
change |= set_button(tSFC,state,pC);
change |= set_button(tSFC,state,pSTART);
change |= set_button(tSFC,state,pMODE);
change |= set_button(tSFC,state,pX);
change |= set_button(tSFC,state,pY);
change |= set_button(tSFC,state,pZ);
// Joystick情報送信
if(change)
{
#if __Debug
///////////////////////////////////////////////////////////////////////////////
Serial.print("SFC :");
Serial.print(state,BIN);
Serial.print("\n");
Serial.print("Joystick.sendState()\n");
///////////////////////////////////////////////////////////////////////////////
#endif //__Debug
Joystick.sendState();
}
//次回ポーリング開始待ち
delay(SCAN_TIME);
}