Comment calculer un déplacement?

Bonjour à tous,

Voilà, je vous expose mon problème. J'ai écris une méthode qui calcule le déplacement de mon joueur dans un environnement à 3 dimensions. Cela fonction bien, mais les déplacements diagonaux sont plus rapides. Sans doute une logique trigonométrique que je n'ai pas maîtrisée.

Alors, des suggestions?

Code C++

void Player::Move(bool front, bool back, bool left, bool right, float elapsedTime)
{
	// Transformer l'angle Y en radian afin de pouvoir appliquer
	// les formules trigonométriques
	float radY = m_rotY / 180.f * PI;

	// Déterminer la velocité de l'axe X et Z
	float velX = ((left ? -1.f : 0.f) + (right ? 1.f : 0.f)) * elapsedTime;
	float velZ = ((back ? -1.f : 0.f) + (front ? 1.f : 0.f)) * elapsedTime;

	// Déterminer la postion en X et Z avec les cos et les sin
	m_posX+= velZ * sin(radY) + velX * cos(radY);
	m_posZ+= velX * sin(radY) - velZ * cos(radY);
}

m_rotY, m_posX, m_posZ sont respectivement : la rotation en Y du joueur, la position en X du joueur et la position en Z du joueur. En respectant que l'axe des X gère la gauche et la droite, l'axe des Z gère l'avant et l'arrière et l'axe des Y gère le haut et le bas.

Merci de votre collaboration.
Hugo.