void FirstPersonCamera::moveForwardDiscretely(int units)
{
glm::vec3 x = glm::vec3(1.0, 0.0, 0.0);
glm::vec3 z = glm::vec3(0.0, 0.0, 1.0);
glm::vec3 ae = at - eye;
float xComp = glm::dot(x, ae);
float zComp = glm::dot(z, ae);
float delta;
// forward/back moves along major axis
// Move along Z axis
if(glm::abs(zComp) > glm::abs(xComp))
{
if(zComp <= 0)
{
units = -units;
}
delta = (glm::floor(eye.z) + 0.5 + units) - eye.z;
moveEye(glm::vec3(0.0, 0.0, delta));
moveAt(glm::vec3(0.0, 0.0, delta));
}
// Move along X axis
else //(zComp => xComp)
{
if(xComp <= 0)
{
units = -units;
}
delta = (glm::floor(eye.x) + 0.5 + units) - eye.x;
moveEye(glm::vec3(delta, 0.0, 0.0));
moveAt(glm::vec3(delta, 0.0, 0.0));
}
}
// TODO: implement this
void FirstPersonCamera::strafeRightDiscretely(int units)
{
glm::vec3 x = glm::vec3(1.0, 0.0, 0.0);
glm::vec3 z = glm::vec3(0.0, 0.0, 1.0);
glm::vec3 ae = at - eye;
float xComp = glm::dot(x, ae);
float zComp = glm::dot(z, ae);
float delta;
// strafe moves along minor axis
// Strafe along X axis
if(glm::abs(zComp) > glm::abs(xComp))
{
if(zComp > 0)
{
units = -units;
}
delta = (glm::floor(eye.x) + 0.5 + units) - eye.x;
moveEye(glm::vec3(delta, 0.0, 0.0));
moveAt(glm::vec3(delta, 0.0, 0.0));
}
// Strafe along Z axis
else //(xComp >= zComp)
{
if(xComp <= 0)
{
units = -units;
}
delta = (glm::floor(eye.z) + 0.5 + units) - eye.z;
moveEye(glm::vec3(0.0, 0.0, delta));
moveAt(glm::vec3(0.0, 0.0, delta));
}
}
IK_GazeResult::List Gaze::execute(bool move_head, bool move_leye, bool move_reye, bool simulate)
{
if(!m_targetIsSet)
return IK_GazeResult::GAZE_ERROR;
int result_head = 0;
int result_eyes = 0;
if(move_head)
if( !moveHead(simulate) )
result_head = 1;
if(move_leye)
if( !moveEye(m_leye, m_aux_leye, simulate) )
result_eyes = 1;
if(move_reye)
if( !moveEye(m_reye, m_aux_reye, simulate) )
result_eyes = 1;
m_targetIsSet = false;
return (IK_GazeResult::List)(1 + result_eyes + 2*result_head);
}
void FirstPersonCamera::handleInput(InputMap &input)
{
double x = input.ranges[Input::RANGE_ROTATE_CAMERA_X];
double y = input.ranges[Input::RANGE_ROTATE_CAMERA_Y];
if(input.actions.find(Input::ACTION_MOVE_DISCRETELY) != input.actions.end())
{
moveDiscretely = !moveDiscretely;
lastMoved = 0;
}
if(input.states.find(Input::STATE_CAMERA_ROTATE) != input.states.end())
{
rotateY(-x);
rotateX(y);
}
if(input.states.find(Input::STATE_CAMERA_MOVE_FORWARD) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_FORWARD))
{
moveForwardDiscretely(1);
lastMoved |= MOVED_FORWARD;
}
}
else
{
moveTowardsAt(0.25);
}
}
else
{
lastMoved &= ~MOVED_FORWARD;
}
if(input.states.find(Input::STATE_CAMERA_MOVE_BACK) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_BACK))
{
moveForwardDiscretely(-1);
lastMoved = lastMoved | MOVED_BACK;
}
}
else
{
moveTowardsAt(-0.25);
}
}
else
{
lastMoved &= ~MOVED_BACK;
}
if(input.states.find(Input::STATE_CAMERA_MOVE_LEFT) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_LEFT))
{
strafeRightDiscretely(-1);
lastMoved = lastMoved | MOVED_LEFT;
}
}
else
{
strafeRight(-0.25);
}
}
else
{
lastMoved &= ~MOVED_LEFT;
}
if(input.states.find(Input::STATE_CAMERA_MOVE_RIGHT) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_RIGHT))
{
strafeRightDiscretely(1);
lastMoved = lastMoved | MOVED_RIGHT;
}
}
else
{
strafeRight(0.25);
}
}
else
{
lastMoved &= ~MOVED_RIGHT;
}
if(input.states.find(Input::STATE_CAMERA_MOVE_UP) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_UP))
{
moveUpDiscretely(1);
lastMoved = lastMoved | MOVED_UP;
}
}
else
{
moveEye(glm::vec3(0.0, 0.25, 0.0));
moveAt(glm::vec3(0.0, 0.25, 0.0));
}
}
else
{
lastMoved &= ~MOVED_UP;
}
if(input.states.find(Input::STATE_CAMERA_MOVE_DOWN) != input.states.end())
{
if(moveDiscretely)
{
if(!(lastMoved & MOVED_DOWN))
{
moveUpDiscretely(-1);
lastMoved = lastMoved | MOVED_DOWN;
}
}
else
{
moveEye(glm::vec3(0.0, -0.25, 0.0));
moveAt(glm::vec3(0.0, -0.25, 0.0));
}
}
else
{
lastMoved &= ~MOVED_DOWN;
}
}
void FirstPersonCamera::moveUpDiscretely(int units)
{
float delta = (glm::floor(eye.y) + 0.5 + units) - eye.y;
moveEye(glm::vec3(0.0, delta, 0.0));
moveAt(glm::vec3(0.0, delta, 0.0));
}
