double Ship::AIFaceOrient(const vector3d &dir, const vector3d &updir)
{
double timeStep = Pi::GetTimeStep();
matrix4x4d rot; GetRotMatrix(rot);
double maxAccel = GetShipType().angThrust / GetAngularInertia(); // should probably be in stats anyway
double frameAccel = maxAccel * timeStep;
if (dir.Dot(vector3d(rot[8], rot[9], rot[10])) > -0.999999)
{ AIFaceDirection(dir); return false; }
vector3d uphead = (updir * rot).Normalized(); // create desired object-space updir
vector3d dav(0.0, 0.0, 0.0); // desired angular velocity
double ang = 0.0;
if (uphead.y < 0.999999)
{
ang = acos(Clamp(uphead.y, -1.0, 1.0)); // scalar angle from head to curhead
double iangvel = sqrt(2.0 * maxAccel * ang); // ideal angvel at current time
double frameEndAV = iangvel - frameAccel;
if (frameEndAV <= 0.0) iangvel = ang / timeStep; // last frame discrete correction
else iangvel = (iangvel + frameEndAV) * 0.5; // discrete overshoot correction
dav.z = -iangvel;
}
vector3d cav = (GetAngVelocity() - GetFrame()->GetAngVelocity()) * rot; // current obj-rel angvel
// vector3d cav = GetAngVelocity() * rot; // current obj-rel angvel
vector3d diff = (dav - cav) / frameAccel; // find diff between current & desired angvel
SetAngThrusterState(diff);
return ang;
// if (diff.x*diff.x > 1.0 || diff.y*diff.y > 1.0 || diff.z*diff.z > 1.0) return false;
// else return true;
}
void Player::PollControls(const float timeStep)
{
static bool stickySpeedKey = false;
if (Pi::game->GetTimeAccel() == Game::TIMEACCEL_PAUSED || Pi::player->IsDead() || GetFlightState() != FLYING)
return;
// if flying
{
ClearThrusterState();
SetGunState(0,0);
SetGunState(1,0);
vector3d wantAngVel(0.0);
double angThrustSoftness = 50.0;
// have to use this function. SDL mouse position event is bugged in windows
int mouseMotion[2];
SDL_GetRelativeMouseState (mouseMotion+0, mouseMotion+1); // call to flush
if (Pi::MouseButtonState(SDL_BUTTON_RIGHT))
{
matrix4x4d rot; GetRotMatrix(rot);
if (!m_mouseActive) {
m_mouseDir = vector3d(-rot[8],-rot[9],-rot[10]); // in world space
m_mouseX = m_mouseY = 0;
m_mouseActive = true;
}
vector3d objDir = m_mouseDir * rot;
const double radiansPerPixel = 0.002;
m_mouseX += mouseMotion[0] * radiansPerPixel;
double modx = clipmouse(objDir.x, m_mouseX);
m_mouseX -= modx;
const bool invertY = (Pi::IsMouseYInvert() ? !m_invertMouse : m_invertMouse);
m_mouseY += mouseMotion[1] * radiansPerPixel * (invertY ? -1 : 1);
double mody = clipmouse(objDir.y, m_mouseY);
m_mouseY -= mody;
if(!float_is_zero_general(modx) || !float_is_zero_general(mody)) {
matrix4x4d mrot = matrix4x4d::RotateYMatrix(modx); mrot.RotateX(mody);
m_mouseDir = (rot * (mrot * objDir)).Normalized();
}
}
else m_mouseActive = false;
// disable all keyboard controls while the console is active
if (!Pi::IsConsoleActive()) {
if (m_flightControlState == CONTROL_FIXSPEED) {
double oldSpeed = m_setSpeed;
if (stickySpeedKey) {
if (!(KeyBindings::increaseSpeed.IsActive() || KeyBindings::decreaseSpeed.IsActive())) {
stickySpeedKey = false;
}
}
if (!stickySpeedKey) {
if (KeyBindings::increaseSpeed.IsActive())
m_setSpeed += std::max(fabs(m_setSpeed)*0.05, 1.0);
if (KeyBindings::decreaseSpeed.IsActive())
m_setSpeed -= std::max(fabs(m_setSpeed)*0.05, 1.0);
if ( ((oldSpeed < 0.0) && (m_setSpeed >= 0.0)) ||
((oldSpeed > 0.0) && (m_setSpeed <= 0.0)) ) {
// flipped from going forward to backwards. make the speed 'stick' at zero
// until the player lets go of the key and presses it again
stickySpeedKey = true;
m_setSpeed = 0;
}
}
}
if (KeyBindings::thrustForward.IsActive()) SetThrusterState(2, -1.0);
if (KeyBindings::thrustBackwards.IsActive()) SetThrusterState(2, 1.0);
if (KeyBindings::thrustUp.IsActive()) SetThrusterState(1, 1.0);
if (KeyBindings::thrustDown.IsActive()) SetThrusterState(1, -1.0);
if (KeyBindings::thrustLeft.IsActive()) SetThrusterState(0, -1.0);
if (KeyBindings::thrustRight.IsActive()) SetThrusterState(0, 1.0);
if (KeyBindings::fireLaser.IsActive() || (Pi::MouseButtonState(SDL_BUTTON_LEFT) && Pi::MouseButtonState(SDL_BUTTON_RIGHT))) {
SetGunState(Pi::worldView->GetActiveWeapon(), 1);
}
if (KeyBindings::yawLeft.IsActive()) wantAngVel.y += 1.0;
if (KeyBindings::yawRight.IsActive()) wantAngVel.y += -1.0;
if (KeyBindings::pitchDown.IsActive()) wantAngVel.x += -1.0;
if (KeyBindings::pitchUp.IsActive()) wantAngVel.x += 1.0;
if (KeyBindings::rollLeft.IsActive()) wantAngVel.z += 1.0;
if (KeyBindings::rollRight.IsActive()) wantAngVel.z -= 1.0;
if (KeyBindings::fastRotate.IsActive())
angThrustSoftness = 10.0;
}
vector3d changeVec;
changeVec.x = KeyBindings::pitchAxis.GetValue();
changeVec.y = KeyBindings::yawAxis.GetValue();
changeVec.z = KeyBindings::rollAxis.GetValue();
// Deadzone
if(changeVec.LengthSqr() < m_joystickDeadzone)
changeVec = vector3d(0.0);
changeVec *= 2.0;
wantAngVel += changeVec;
double invTimeAccelRate = 1.0 / Pi::game->GetTimeAccelRate();
for (int axis=0; axis<3; axis++)
wantAngVel[axis] = Clamp(wantAngVel[axis], -invTimeAccelRate, invTimeAccelRate);
if (m_mouseActive) AIFaceDirection(m_mouseDir);
else AIModelCoordsMatchAngVel(wantAngVel, angThrustSoftness);
}
}
void Player::PollControls(const float timeStep)
{
double time_accel = Pi::GetTimeAccel();
double invTimeAccel = 1.0 / time_accel;
static bool stickySpeedKey = false;
if ((time_accel == 0) || GetDockedWith() || Pi::player->IsDead() ||
(GetFlightState() != FLYING)) {
return;
}
// if flying
{
ClearThrusterState();
vector3d wantAngVel(0.0);
// have to use this function. SDL mouse position event is bugged in windows
int mouseMotion[2];
SDL_GetRelativeMouseState (mouseMotion+0, mouseMotion+1); // call to flush
if (Pi::MouseButtonState(3))
{
matrix4x4d rot; GetRotMatrix(rot);
if (!m_mouseActive) {
m_mouseDir = vector3d(-rot[8],-rot[9],-rot[10]); // in world space
m_mouseX = m_mouseY = 0;
m_mouseActive = true;
}
vector3d objDir = m_mouseDir * rot;
m_mouseX += mouseMotion[0] * 0.002;
double modx = clipmouse(objDir.x, m_mouseX);
m_mouseX -= modx;
m_mouseY += mouseMotion[1] * 0.002; // factor pixels => radians
double mody = clipmouse(objDir.y, m_mouseY);
m_mouseY -= mody;
if(modx != 0.0 || mody != 0.0) {
matrix4x4d mrot = matrix4x4d::RotateYMatrix(modx); mrot.RotateX(mody);
m_mouseDir = (rot * (mrot * objDir)).Normalized();
}
}
else m_mouseActive = false;
if (m_flightControlState == CONTROL_FIXSPEED) {
double oldSpeed = m_setSpeed;
if (stickySpeedKey) {
if (!(KeyBindings::increaseSpeed.IsActive() || KeyBindings::decreaseSpeed.IsActive())) {
stickySpeedKey = false;
}
}
if (!stickySpeedKey) {
if (KeyBindings::increaseSpeed.IsActive()) m_setSpeed += std::max(m_setSpeed*0.05, 1.0);
if (KeyBindings::decreaseSpeed.IsActive()) m_setSpeed -= std::max(m_setSpeed*0.05, 1.0);
if ( ((oldSpeed < 0.0) && (m_setSpeed >= 0.0)) ||
((oldSpeed > 0.0) && (m_setSpeed <= 0.0)) ) {
// flipped from going forward to backwards. make the speed 'stick' at zero
// until the player lets go of the key and presses it again
stickySpeedKey = true;
m_setSpeed = 0;
}
}
}
if (KeyBindings::thrustForward.IsActive()) SetThrusterState(2, -1.0);
if (KeyBindings::thrustBackwards.IsActive()) SetThrusterState(2, 1.0);
if (KeyBindings::thrustUp.IsActive()) SetThrusterState(1, 1.0);
if (KeyBindings::thrustDown.IsActive()) SetThrusterState(1, -1.0);
if (KeyBindings::thrustLeft.IsActive()) SetThrusterState(0, -1.0);
if (KeyBindings::thrustRight.IsActive()) SetThrusterState(0, 1.0);
SetGunState(0,0);
SetGunState(1,0);
if (KeyBindings::fireLaser.IsActive() || (Pi::MouseButtonState(1) && Pi::MouseButtonState(3))) {
SetGunState(Pi::worldView->GetActiveWeapon(), 1);
}
if (KeyBindings::yawLeft.IsActive()) wantAngVel.y += 1.0;
if (KeyBindings::yawRight.IsActive()) wantAngVel.y += -1.0;
if (KeyBindings::pitchDown.IsActive()) wantAngVel.x += -1.0;
if (KeyBindings::pitchUp.IsActive()) wantAngVel.x += 1.0;
if (KeyBindings::rollLeft.IsActive()) wantAngVel.z += 1.0;
if (KeyBindings::rollRight.IsActive()) wantAngVel.z -= 1.0;
wantAngVel.x += 2 * KeyBindings::pitchAxis.GetValue();
wantAngVel.y += 2 * KeyBindings::yawAxis.GetValue();
wantAngVel.z += 2 * KeyBindings::rollAxis.GetValue();
for (int axis=0; axis<3; axis++)
wantAngVel[axis] = Clamp(wantAngVel[axis], -invTimeAccel, invTimeAccel);
// matrix4x4d rot; GetRotMatrix(rot);
const double angThrustSoftness = KeyBindings::fastRotate.IsActive() ? 10.0 : 50.0;
if (m_mouseActive) AIFaceDirection(m_mouseDir);
else AIModelCoordsMatchAngVel(wantAngVel, angThrustSoftness);
}
}
