projekty/Source/example1/src/conv.c

Go to the documentation of this file.

/*
 * $Id: conv.c,v 1.0 2005/05/17 8:40:00 BorisK Exp $
 *
 * Copyright (C) 2005 ONTRACK s.r.o.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA    
 * 02111-1307, USA.
 *
 * [1] ARM-based Microcontroller LPC2119/2129/2194/2292/9994, "Preliminary User Manual", February 03, 2004
 *
 * Written by Boris Kralik <kralikbo@yahoo.com>, 2005
 *
 */
#include "conv.h"
short   char2num(char inp)
{
        return (inp-0x30);
}
int _memcmp(char *cs, char *ct, int count)
{
         char *su1, *su2;
         int res = 0;

         for (su1 = cs, su2 = ct; 0 < count; ++su1, ++su2, count--)
                 if ((res = *su1 - *su2) != 0)
                         break;
         return res;
}
unsigned char *_strstr(unsigned char *s1,unsigned char *s2)
{
         int l1, l2;

         l2 = strlen(s2);
         if (!l2)
         {
                        #if 0
                                UARTWriteStr("\n\rl2==0");UARTWriteStr(itoa_16(l2));
                        #endif
                 return (unsigned char *)s1;       
         }
         l2-=1;
         l1 = strlen(s1);
        #if 0
                UARTWriteStr("\n\rs1=");UARTWriteStr(s1);
                UARTWriteStr("\n\rl1=");UARTWriteStr(itoa_16(l1));
                UARTWriteStr("\n\rl2=");UARTWriteStr(itoa_16(l2));
                UARTWriteStr("\n\rs2=");UARTWriteStr(s2);
        #endif
         while (l1 >= l2) {
                 l1--;
                 if (!_memcmp(s1, s2, l2))
                         return (unsigned char *)s1;
                 s1++;
         }
         return NULL;
}
int iContNum(unsigned char *uchPulse,unsigned char *uchPattern)
{
        int     vyskyt  =       0;
        int     iLen    =       _strlen(uchPulse);
        int     iPoc    =       0;
        #if 0
                UARTWriteStr("\n\riContNum:uchPulse  =");UARTWriteStr(uchPulse);
                UARTWriteStr("\n\riContNum:uchPattern=");UARTWriteStr(uchPattern);
        #endif
        do
        {
                uchPulse=_strstr(uchPulse,uchPattern);
                if (uchPulse == NULL)
                {
                        #if 0
                                UARTWriteStr("\n\riContNum:vyskyt1=");UARTWriteStr(itoa_16(vyskyt));
                                UARTWriteStr("\n\riContNum:iPoc=");UARTWriteStr(itoa_16(iPoc));
                        #endif
                        iPoc++;
                        return (vyskyt);
                }
                uchPulse+=_strlen(uchPattern);
                vyskyt++;
        }while(_strlen(uchPulse) != 0);
        #if 0
                UARTWriteStr("\n\riContNum:vyskyt2=");UARTWriteStr(itoa_16(vyskyt));
        #endif
        return (vyskyt-1);
}
/*
        Name:           strlen
        Parameter:      char *
        Return:         int
        Description:    Function return number chars in input string
*/
int strlen(char *s)
{
        char *sc;
#if 0
        printf("\n\rstrlen(%s)",s);
#endif
         for (sc = s; *sc != '\0'; ++sc)
                #if 0
                        printf("\n\rsc:%s",sc);
                #else
                        /* nothing */;
                #endif
#if 0
        printf("\n\rstrlen(%s)=%d",s,(sc-s));
#endif
         return sc - s;
}
int _strlen(char *s)
{
         char *sc;
 
         for (sc = s; *sc != '\0'; ++sc)
                 /* nothing */;
         return sc - s;
}

char *strcat(char *str1,char *str2)
{
  int i,j;
  char *ptr;
  char buf[200]="";
  ptr = &buf[200];
  for(i=0;i<strlen(str1);i++)
    {
      ptr[i]=str1[i];
    }
  for(j=0;j<strlen(str2);j++)
    {
      ptr[i+j]=str2[j];
    }
  ptr[i+j+1]='\x0';
  return ptr;
}

char *int2string(int val){
    char buffer[12]="";
    char *ptr;
    ptr=&buffer[12];
    *ptr=0;
    ptr--;
    do {
         *ptr = 48 + (val % 10);
         val = val / 10;
         ptr--;
    } while (val);
    ptr++;
    return ptr;
}

char *itoa_16(int val){
    char buffer[13]="";
    char *ptr;
    ptr=&buffer[13];
    *ptr=0;
    ptr--;
    do {
         *ptr = 48 + (val % 16);
         if (*ptr > 57) *ptr=(55 + (val % 16));
         val = val / 16;
         ptr--;
    } while (val);
    ptr++;
    return ptr;
}

short   strcmp(char *str1,char *str2)
{
        int i=0,n1=strlen(str1);
        #if 0
                                printf("\n\rstrcmp(%s,%s)=%d",str1,str2,n);
        #endif  
        if (n1 != strlen(str2)) return 0;
        do{
                if (str1[i]!=str2[i]) {
                        #if 0
                                printf("\n\rreturn 0");
                        #endif
                        return 0;}
        }while(str1[++i]!=0);
        
        return n1;
}

---