mirror/tp
1
0
Fork 0
mirror of https://github.com/zeldaret/tp synced 2026-05-24 15:21:08 -04:00
Code Issues Packages Projects Releases Wiki Activity
Files
763400c4c0e2536bbfe2dd3032905dde8db031ca
tp/src/d/d_vibration.cpp
T
TakaRikka 2453c0e333 copy dolsdk2004 to tp / b_bh + e_mb done (#2299) 
* move dolsdk2004 over

* cleanup some temp work

* finish and cleanup gf

* b_bh done

* d_a_e_mb done
2025-02-10 21:20:42 +02:00

462 lines
16 KiB
C++
Raw Blame History

#include "d/d_vibration.h"
#include "d/d_com_inf_game.h"
#include "m_Do/m_Do_controller_pad.h"
#include "SSystem/SComponent/c_math.h"
#include <limits.h>
#define RESET_FRAME -99
#define RUMBLE_SHOCK 1
#define RUMBLE_QUAKE 2
#define FLAG_CAMERA_VIB 0x7E
#define FLAG_MOTOR_VIB 0x1
namespace {
/* 8006F168-8006F184 069AA8 001C+00 1/1 0/0 0/0 .text makedata__25@unnamed@d_vibration_cpp@FPUsUll
*/
u16* makedata(u16* data, u32 pattern, s32 length) {
data[0] = length;
data[1] = pattern >> 16;
data[2] = pattern;
data[3] = 0;
return data;
}
/* 8006F184-8006F1A4 069AC4 0020+00 1/1 0/0 0/0 .text rollshift__25@unnamed@d_vibration_cpp@FUlll
*/
s32 rollshift(u32 pattern, s32 length, s32 index) {
index %= length;
return (pattern >> index) | (pattern << (length - index));
}
/* 8006F1A4-8006F1D8 069AE4 0034+00 2/2 0/0 0/0 .text makebits__25@unnamed@d_vibration_cpp@FUlll
*/
u32 makebits(u32 bits, s32 length, s32 numbits) {
s32 i;
u32 mask = bits & (-1 << (32 - length));
bits = mask;
for (i = length; i < numbits; i += length) {
bits = mask | (bits >> length);
}
return bits;
}
/* 8006F1D8-8006F268 069B18 0090+00 1/1 0/0 0/0 .text randombit__25@unnamed@d_vibration_cpp@Fll */
u32 randombit(s32 rounds, s32 length) {
u32 value = 0;
for (int i = 0; i < rounds; i++) {
value |= 0x40000000 >> (u32)(length * cM_rnd());
}
return value;
}
};
/* 8006F268-8006FA24 069BA8 07BC+00 0/0 2/2 0/0 .text Run__12dVibration_cFv */
int dVibration_c::Run() {
mMode = MODE_RUN;
if (dComIfGs_checkOptVibration() != 1) {
if (mMotor.mShock.mVibMode != VIBMODE_S_NONE) {
mMotor.mShock.mVibMode = VIBMODE_S_NONE;
mMotor.mShock.field_0x0 |= 1;
}
if (mMotor.mQuake.mVibMode != VIBMODE_Q_NONE) {
mMotor.mQuake.mVibMode = VIBMODE_Q_NONE;
mMotor.mQuake.field_0x0 |= 1;
}
mMotor.mQuake.mFrame = RESET_FRAME;
mMotor.mShock.mFrame = RESET_FRAME;
}
if ((mCamera.mShock.field_0x0 & 1) && mCamera.mShock.mFrame != RESET_FRAME) {
mCamera.mShock.mFrame = 0;
mCamera.mShock.mVibMode = VIBMODE_S_NONE;
}
if ((mCamera.mQuake.field_0x0 & 1) && mCamera.mQuake.mFrame != RESET_FRAME) {
mCamera.mQuake.mFrame = 0;
mCamera.mQuake.mVibMode = VIBMODE_Q_NONE;
}
if (mCamera.mShock.mFrame == 0 || mCamera.mQuake.mFrame == 0) {
u32 rumble = 0;
if (mCamera.mShock.mVibMode == VIBMODE_S_NONE || (mCamera.mShock.field_0x0 & 1)) {
mCamera.mShock.mFrame = RESET_FRAME;
mCamera.mShock.mPattern = 0;
mCamera.mShock.mLength = 0;
mCamera.mShock.mRounds = 0;
} else if (mCamera.mShock.mFrame >= 0) {
rumble |= RUMBLE_SHOCK;
}
if (mCamera.mQuake.mVibMode == VIBMODE_Q_NONE || (mCamera.mQuake.field_0x0 & 1)) {
mCamera.mQuake.mFrame = RESET_FRAME;
mCamera.mQuake.mPattern = 0;
mCamera.mQuake.mLength = 0;
mCamera.mQuake.mRounds = 0;
} else if (mCamera.mQuake.mFrame >= 0) {
rumble |= RUMBLE_QUAKE;
}
s32 length, pattern, bits, flags;
switch (rumble) {
case RUMBLE_SHOCK:
length = mCamera.mShock.mLength;
pattern = mCamera.mShock.mPattern;
pattern |= randombit(mCamera.mShock.mRounds, length);
flags = mCamera.mShock.mFlags;
if (dKy_darkworld_check()) {
flags &= ~0x30;
}
if (dComIfGp_getCamera(0) != NULL && dComIfGp_getCamera(0)->field_0x22f == 0x47) {
dCam_getBody()->StartShake(length, (u8*)&pattern, flags, mCamera.mShock.mPos.norm());
}
break;
case RUMBLE_QUAKE:
length = mCamera.mQuake.mLength;
pattern = rollshift(mCamera.mQuake.mPattern, length, mFrame);
pattern |= randombit(mCamera.mQuake.mRounds, length);
flags = mCamera.mQuake.mFlags;
if (dKy_darkworld_check()) {
flags &= ~0x30;
}
if (dComIfGp_getCamera(0) != NULL && dComIfGp_getCamera(0)->field_0x22f == 0x47) {
dCam_getBody()->StartShake(length, (u8*)&pattern, flags, mCamera.mQuake.mPos.norm());
}
break;
case RUMBLE_SHOCK | RUMBLE_QUAKE:
pattern = mCamera.mShock.mPattern << mCamera.mShock.mFrame;
length = mCamera.mShock.mLength - mCamera.mShock.mFrame;
pattern |= rollshift(makebits(mCamera.mQuake.mPattern, mCamera.mQuake.mLength, length), length, mFrame);
pattern |= randombit(mCamera.mShock.mRounds > mCamera.mQuake.mRounds ? mCamera.mShock.mRounds : mCamera.mQuake.mRounds, length);
flags = mCamera.mShock.mFlags | mCamera.mQuake.mFlags;
if (dKy_darkworld_check()) {
flags &= ~0x30;
}
if (dComIfGp_getCamera(0) != NULL && dComIfGp_getCamera(0)->field_0x22f == 0x47) {
dCam_getBody()->StartShake(length, (u8*)&pattern, flags, cXyz(mCamera.mShock.mPos + mCamera.mQuake.mPos).norm());
}
mCamera.mQuake.mFrame = 0;
mCamera.mShock.mFrame = 0;
break;
default:
if (dComIfGp_getCamera(0) != NULL && dComIfGp_getCamera(0)->field_0x22f == 0x47) {
dCam_getBody()->StopShake();
}
break;
}
}
if ((mMotor.mShock.field_0x0 & 1) && mMotor.mShock.mFrame != RESET_FRAME) {
mMotor.mShock.mFrame = 0;
mMotor.mShock.mVibMode = VIBMODE_S_NONE;
}
if ((mMotor.mQuake.field_0x0 & 1) && mMotor.mQuake.mFrame != RESET_FRAME) {
mMotor.mQuake.mFrame = 0;
mMotor.mQuake.mVibMode = VIBMODE_Q_NONE;
}
if (mMotor.mShock.mFrame == 0 || mMotor.mQuake.mFrame == 0) {
u32 rumble = 0;
if (mMotor.mShock.mVibMode == VIBMODE_S_NONE || (mMotor.mShock.field_0x0 & 1)) {
mMotor.mShock.mFrame = RESET_FRAME;
mMotor.mShock.mPattern = 0;
mMotor.mShock.mLength = 0;
mMotor.mShock.mRounds = 0;
} else if (mMotor.mShock.mFrame >= 0) {
rumble |= RUMBLE_SHOCK;
}
if (mMotor.mQuake.mVibMode == VIBMODE_Q_NONE || (mMotor.mQuake.field_0x0 & 1)) {
mMotor.mQuake.mFrame = RESET_FRAME;
mMotor.mQuake.mPattern = 0;
mMotor.mQuake.mLength = 0;
mMotor.mQuake.mRounds = 0;
} else if (mMotor.mQuake.mFrame >= 0) {
rumble |= RUMBLE_QUAKE;
}
static u16 data[4];
s32 pattern, length, bits;
switch (rumble) {
case RUMBLE_SHOCK:
length = mMotor.mShock.mLength;
pattern = mMotor.mShock.mPattern;
pattern |= randombit(mMotor.mShock.mRounds, length);
mMotor.mShock.mStopFrame = length;
mDoCPd_c::startMotorWave(PAD_1, makedata(data, pattern, length), JUTGamePad::CRumble::VAL_0, 60);
break;
case RUMBLE_QUAKE:
length = mMotor.mQuake.mLength;
pattern = rollshift(mMotor.mQuake.mPattern, length, mFrame);
pattern |= randombit(mMotor.mQuake.mRounds, length);
mMotor.mQuake.mStopFrame = INT_MAX;
mDoCPd_c::startMotorWave(PAD_1, makedata(data, pattern, length), JUTGamePad::CRumble::VAL_1, 60);
break;
case RUMBLE_SHOCK | RUMBLE_QUAKE:
pattern = mMotor.mShock.mPattern << mMotor.mShock.mFrame;
length = mMotor.mShock.mLength - mMotor.mShock.mFrame;
pattern |= rollshift(makebits(mMotor.mQuake.mPattern, mMotor.mQuake.mLength, length), length, mFrame);
pattern |= randombit(mMotor.mShock.mRounds > mMotor.mQuake.mRounds ? mMotor.mShock.mRounds : mMotor.mQuake.mRounds, length);
mMotor.mQuake.mStopFrame = length;
mMotor.mShock.mStopFrame = length;
mMotor.mQuake.mFrame = 0;
mMotor.mShock.mFrame = 0;
mDoCPd_c::startMotorWave(PAD_1, makedata(data, pattern, length), JUTGamePad::CRumble::VAL_0, 60);
break;
default:
mDoCPd_c::stopMotorWave(PAD_1);
mDoCPd_c::stopMotor(PAD_1);
mMotor.mQuake.mStopFrame = RESET_FRAME;
mMotor.mShock.mStopFrame = RESET_FRAME;
break;
}
}
mCamera.mQuake.field_0x0 = 0;
mCamera.mShock.field_0x0 = 0;
mMotor.mQuake.field_0x0 = 0;
mMotor.mShock.field_0x0 = 0;
if (mCamera.mShock.mFrame >= 0) {
mCamera.mShock.mFrame++;
if (mCamera.mShock.mFrame > mCamera.mShock.mLength) {
mCamera.mShock.field_0x0 |= 1;
}
}
if (mMotor.mShock.mFrame >= 0) {
mMotor.mShock.mFrame++;
if (mMotor.mShock.mFrame > mMotor.mShock.mStopFrame) {
mMotor.mShock.field_0x0 |= 1;
}
}
if (mCamera.mQuake.mFrame >= 0) {
mCamera.mQuake.mFrame++;
if (mCamera.mQuake.mFrame > mCamera.mQuake.mLength) {
mCamera.mQuake.mFrame = 0;
}
}
if (mMotor.mQuake.mFrame >= 930) {
mMotor.mQuake.mFrame = 0;
} else if (mMotor.mQuake.mFrame >= 900) {
mDoCPd_c::stopMotorWave(PAD_1);
mDoCPd_c::stopMotor(PAD_1);
mMotor.mQuake.mFrame++;
} else if (mMotor.mQuake.mFrame >= 0) {
mMotor.mQuake.mFrame++;
if (mMotor.mQuake.mFrame > mMotor.mQuake.mStopFrame) {
mMotor.mQuake.mFrame = 0;
}
}
mFrame++;
return 1;
}
/* 8006FA24-8006FB10 06A364 00EC+00 0/0 62/62 298/298 .text StartShock__12dVibration_cFii4cXyz */
bool dVibration_c::StartShock(int i_vibmode, int i_flags, cXyz i_pos) {
bool ret = false;
if (i_flags & FLAG_CAMERA_VIB) {
mCamera.mShock.mVibMode = i_vibmode;
mCamera.mShock.mFrame = 0;
mCamera.mShock.mFlags = i_flags;
mCamera.mShock.mPos = i_pos;
mCamera.mShock.mPattern = CS_patt[i_vibmode].bits;
mCamera.mShock.mLength = CS_patt[i_vibmode].length;
mCamera.mShock.mRounds = CS_patt[i_vibmode].rounds;
ret = true;
}
if ((i_flags & FLAG_MOTOR_VIB) && dComIfGs_checkOptVibration() == 1) {
mMotor.mShock.mVibMode = i_vibmode;
mMotor.mShock.mFrame = 0;
mMotor.mShock.mPattern = MS_patt[i_vibmode].bits;
mMotor.mShock.mLength = MS_patt[i_vibmode].length;
ret = true;
}
return ret;
}
/* 8006FB10-8006FC0C 06A450 00FC+00 0/0 8/8 67/67 .text StartQuake__12dVibration_cFii4cXyz */
bool dVibration_c::StartQuake(int i_vibmode, int i_flags, cXyz i_pos) {
bool ret = false;
if (i_flags & FLAG_CAMERA_VIB) {
mCamera.mQuake.mVibMode = i_vibmode;
mCamera.mQuake.mFrame = 0;
mCamera.mQuake.mFlags = i_flags;
mCamera.mQuake.mPos = i_pos;
mCamera.mQuake.mPattern = CQ_patt[i_vibmode].bits;
mCamera.mQuake.mLength = CQ_patt[i_vibmode].length;
mCamera.mQuake.mRounds = CQ_patt[i_vibmode].rounds;
ret = true;
}
if ((i_flags & FLAG_MOTOR_VIB) && dComIfGs_checkOptVibration() == 1) {
mMotor.mQuake.mVibMode = i_vibmode;
mMotor.mQuake.mFrame = 0;
mMotor.mQuake.mPattern = MQ_patt[i_vibmode].bits;
mMotor.mQuake.mLength = MQ_patt[i_vibmode].length;
mMotor.mQuake.mRounds = CQ_patt[i_vibmode].rounds;
ret = true;
}
return ret;
}
/* 8006FC0C-8006FD94 06A54C 0188+00 0/0 2/2 2/2 .text StartQuake__12dVibration_cFPCUcii4cXyz */
bool dVibration_c::StartQuake(const u8* i_pattern, int i_rounds, int i_flags, cXyz i_pos) {
bool ret = false;
int length = (i_pattern[0] << 8) | i_pattern[1];
u32 bits = i_pattern[length >= 1 ? 2 : 0] << 24 |
i_pattern[length >= 9 ? 3 : 0] << 16 |
i_pattern[length >= 17 ? 4 : 0] << 8 |
i_pattern[length >= 25 ? 5 : 0] << 0;
if (i_flags & FLAG_CAMERA_VIB) {
mCamera.mQuake.mVibMode = VIBMODE_Q_CUSTOM;
mCamera.mQuake.mFrame = 0;
mCamera.mQuake.mFlags = i_flags;
mCamera.mQuake.mPos = i_pos;
mCamera.mQuake.mPattern = makebits(bits, i_pattern[1], 32);
mCamera.mQuake.mLength = 32;
mCamera.mQuake.mRounds = i_rounds;
ret = true;
}
if ((i_flags & FLAG_MOTOR_VIB) && dComIfGs_checkOptVibration() == 1) {
mMotor.mQuake.mVibMode = VIBMODE_Q_CUSTOM;
mMotor.mQuake.mFrame = 0;
mMotor.mQuake.mPattern = makebits(bits, i_pattern[1], 32);
mMotor.mQuake.mLength = 32;
mMotor.mQuake.mRounds = i_rounds;
ret = true;
}
return ret;
}
/* 8006FD94-8006FE00 06A6D4 006C+00 0/0 6/6 82/82 .text StopQuake__12dVibration_cFi */
int dVibration_c::StopQuake(int i_flags) {
int ret = FALSE;
if (i_flags & FLAG_CAMERA_VIB) {
if (mCamera.mQuake.mFrame >= 0) {
mCamera.mQuake.mFlags &= ~i_flags;
if (mCamera.mQuake.mFlags == 0) {
mCamera.mQuake.field_0x0 |= 1;
}
ret = TRUE;
}
}
if ((i_flags & FLAG_MOTOR_VIB) && mMotor.mQuake.mFrame >= 0) {
mMotor.mQuake.field_0x0 |= 1;
ret = TRUE;
}
return ret;
}
/* 8006FE00-8006FE5C 06A740 005C+00 2/2 0/0 0/0 .text Kill__12dVibration_cFv */
void dVibration_c::Kill() {
mDoCPd_c::stopMotorWaveHard(PAD_1);
mDoCPd_c::stopMotorHard(PAD_1);
setDefault();
}
/* 8006FE5C-8006FE84 06A79C 0028+00 0/0 0/0 10/10 .text CheckQuake__12dVibration_cFv */
bool dVibration_c::CheckQuake() {
return mCamera.mQuake.mVibMode != VIBMODE_Q_NONE || mMotor.mQuake.mVibMode != VIBMODE_Q_NONE;
}
/* 8006FE84-8006FF04 06A7C4 0080+00 2/2 0/0 0/0 .text setDefault__12dVibration_cFv */
void dVibration_c::setDefault() {
mMotor.mShock.mVibMode = VIBMODE_S_NONE;
mCamera.mShock.mVibMode = VIBMODE_S_NONE;
mMotor.mQuake.mVibMode = VIBMODE_Q_NONE;
mCamera.mQuake.mVibMode = VIBMODE_Q_NONE;
mMotor.mShock.field_0x0 = 0;
mCamera.mShock.field_0x0 = 0;
mMotor.mQuake.field_0x0 = 0;
mCamera.mQuake.field_0x0 = 0;
mMotor.mShock.mPattern = 0;
mCamera.mShock.mPattern = 0;
mMotor.mQuake.mPattern = 0;
mCamera.mQuake.mPattern = 0;
mMotor.mShock.mLength = 0;
mCamera.mShock.mLength = 0;
mMotor.mQuake.mLength = 0;
mCamera.mQuake.mLength = 0;
mMotor.mShock.mRounds = 0;
mCamera.mShock.mRounds = 0;
mMotor.mQuake.mRounds = 0;
mCamera.mQuake.mRounds = 0;
mMotor.mShock.mFrame = RESET_FRAME;
mCamera.mShock.mFrame = RESET_FRAME;
mMotor.mQuake.mFrame = RESET_FRAME;
mCamera.mQuake.mFrame = RESET_FRAME;
mMotor.mShock.mStopFrame = RESET_FRAME;
mMotor.mQuake.mStopFrame = RESET_FRAME;
mMode = MODE_WAIT;
mFrame = 0;
}
/* 8006FF04-8006FF38 06A844 0034+00 0/0 2/2 0/0 .text Init__12dVibration_cFv */
void dVibration_c::Init() {
Kill();
setDefault();
}
/* 8006FF38-8006FFF8 06A878 00C0+00 0/0 1/1 0/0 .text Pause__12dVibration_cFv */
void dVibration_c::Pause() {
if (mMode != MODE_PAUSE) {
if (mMotor.mShock.mVibMode != VIBMODE_S_NONE || mMotor.mQuake.mVibMode != VIBMODE_Q_NONE) {
mDoCPd_c::stopMotorWaveHard(PAD_1);
mDoCPd_c::stopMotorHard(PAD_1);
}
mMotor.mShock.mVibMode = VIBMODE_S_NONE;
mCamera.mShock.mVibMode = VIBMODE_S_NONE;
mMotor.mShock.mFrame = RESET_FRAME;
mCamera.mShock.mFrame = RESET_FRAME;
if (mCamera.mQuake.mVibMode != VIBMODE_Q_NONE) {
mCamera.mQuake.mFrame = 0;
}
if (mMotor.mQuake.mVibMode != VIBMODE_Q_NONE) {
mMotor.mQuake.mFrame = 0;
}
mMode = MODE_PAUSE;
}
}
/* 8006FFF8-80070018 06A938 0020+00 0/0 1/1 0/0 .text Remove__12dVibration_cFv */
void dVibration_c::Remove() {
Kill();
}
Reference in New Issue View Git Blame Copy Permalink