Movement fix

void MovementFix( CUserCmd* pCmd, QAngle qaView, QAngle qaAim )
{
    Vector vecMove( pCmd->forwardmove, pCmd->sidemove, pCmd->upmove );

    Vector vecMoveNorm;
    VectorCopy( vecMove, vecMoveNorm );
    vecMoveNorm.NormalizeInPlace( );

    QAngle qaMoveNorm;
    VectorAngles( vecMoveNorm, qaMoveNorm );

    QAngle qaAdjusted = qaMoveNorm + ( qaAim - qaView );
    Vector vecForward, vecSide, vecUp;
    AngleVectors( qaAdjusted, &vecForward, &vecSide, &vecUp );

    Vector vecSet = vecForward * vecMove.Length();

    pCmd->forwardmove = vecSet.x;
    pCmd->sidemove = vecSet.y;
}