urlDecode() funktion virker ikke

Jeg har fundet flg. kode på nettet, men det virker ikke .. crasher programmet når den køres.

void urlDecode (char *p)
{
    char *pD = p;

    while (*p)
    {
        if (*p == '%')
        {           
              p++;

              if (isxdigit(p[0]) && isxdigit(p[1]))
              {
                *pD++ = (char)TwoHex2Int(p);
                *p += 2;
              }
        }
        else
        {
            *pD++ = *p++;
        }
    }

    *pD = '\0';
}

static int TwoHex2Int(char *pC)

{

      int Hi, Lo, Result;

      Hi = pC[0];

      if('0' <= Hi && Hi <= '9')

              Hi -= '0';

      else if('a' <= Hi && Hi <= 'f')

              Hi -= ('a' - 10);

      else if('A' <= Hi && Hi <= 'F')

              Hi -= ('A' - 10);

      Lo = pC[1];

      if('0' <= Lo && Lo <= '9')

              Lo -= '0';

      else if('a' <= Lo && Lo <= 'f')

              Lo -= ('a' - 10);

      else if('A' <= Lo && Lo <= 'F')

              Lo -= ('A' - 10);

      Result = Lo + 16 * Hi;

      return(Result);

}

char *szStr = "Thomas%20Daugaard";

urlDecode(szStr);

burde gerne virke, men det gør det ikke.

Nogle ideer ? Eller er der nogle der har en urlDecode() funktion der virker ?