БагЪ с матрицами в директе

LRESULT WINAPI MsgProc( HWND hWnd, UINT msg, WPARAM wParam, LPARAM lParam )
{
    switch( msg )
    {
        case WM_DESTROY:
            Cleanup();
            PostQuitMessage( 0 );
            return 0;
        case WM_CHAR:
            switch (wParam)
            {
            case 'w':
                m_zPos+=1;
                break;
            case 's':
                m_zPos-=1;
                break;
            case 'a':
                m_xPos-=1;
                break;
            case 'd':
                m_xPos+=1;
            case 'e':
                m_fYaw+=1;
                break;
            case 'q':
                m_fYaw-=1;
                break;
            };

    }

    return DefWindowProc( hWnd, msg, wParam, lParam );
}

VOID SetupMatrices()
{
    D3DXMATRIX MatTemp;  // Temp matrix for rotations.
    D3DXMATRIX MatRot;   // Final rotation matrix, applied to
                         // pMatWorld.
 
    // Using the left-to-right order of matrix concatenation,
    // apply the translation to the object's world position
    // before applying the rotations.
    D3DXMatrixTranslation(&pMatWorld, m_xPos, m_yPos, m_zPos);
    D3DXMatrixIdentity(&MatRot);

    // Now, apply the orientation variables to the world matrix
    if(m_fPitch || m_fYaw || m_fRoll)
    {
        // Produce and combine the rotation matrices.
        D3DXMatrixRotationX(&MatTemp, m_fPitch);         // Pitch
        D3DXMatrixMultiply(&MatRot, &MatRot, &MatTemp);
        D3DXMatrixRotationY(&MatTemp, m_fYaw);           // Yaw
        D3DXMatrixMultiply(&MatRot, &MatRot, &MatTemp);
        D3DXMatrixRotationZ(&MatTemp, m_fRoll);          // Roll
        D3DXMatrixMultiply(&MatRot, &MatRot, &MatTemp);
 
        // Apply the rotation matrices to complete the world matrix.
        D3DXMatrixMultiply(&pMatWorld, &MatRot, &pMatWorld);

        g_pd3dDevice->SetTransform( D3DTS_WORLD, &pMatWorld );
    }
}