161 lines
2.5 KiB
C
161 lines
2.5 KiB
C
#include <string.h>
|
|
|
|
#include <vector_extentions/sse.h>
|
|
|
|
extern int16_t sse_initialized;
|
|
|
|
size_t strlen(const char* str)
|
|
{
|
|
size_t len = 0;
|
|
while (str[len]) len++;
|
|
return len;
|
|
}
|
|
|
|
size_t strcmp(const char *s1, const char *s2)
|
|
{
|
|
int32_t i = 0;
|
|
|
|
while ((s1[i] == s2[i]))
|
|
{
|
|
if (s2[i++] == 0)
|
|
{
|
|
return 0;
|
|
}
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
int32_t strncmp(const char *s1, const char *s2, size_t n)
|
|
{
|
|
while (n--)
|
|
{
|
|
unsigned char c1 = (unsigned char)*s1++;
|
|
unsigned char c2 = (unsigned char)*s2++;
|
|
if (c1 != c2)
|
|
{
|
|
return c1 - c2;
|
|
}
|
|
if (c1 == '\0')
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
size_t strcpy(char *dst, const char *src)
|
|
{
|
|
int32_t i = 0;
|
|
while ((*dst++ = *src++) != 0)
|
|
i++;
|
|
return i;
|
|
}
|
|
|
|
char *strncpy(char *dest, const char *src, uint32_t n)
|
|
{
|
|
if (sse_initialized > 0)
|
|
{
|
|
return sse2_strncpy(dest, src, n);
|
|
}
|
|
|
|
uint32_t i = 0;
|
|
for (; i < n && src[i]; ++i)
|
|
dest[i] = src[i];
|
|
|
|
for (; i < n; ++i)
|
|
dest[i] = '\0';
|
|
|
|
return dest;
|
|
}
|
|
|
|
void strcat(char *dest, const char *src)
|
|
{
|
|
char *end = (char *)dest + strlen(dest);
|
|
memcpy((void *)end, (void *)src, strlen(src));
|
|
end = end + strlen(src);
|
|
*end = '\0';
|
|
}
|
|
|
|
void *memset(void *dst, char c, uint32_t n)
|
|
{
|
|
char *temp = dst;
|
|
for (; n != 0; n--) *temp++ = c;
|
|
return dst;
|
|
}
|
|
|
|
void *memcpy(void *dst, const void *src, uint32_t n)
|
|
{
|
|
if (sse_initialized > 0)
|
|
{
|
|
return sse2_memcpy(dst, src, n);
|
|
}
|
|
|
|
char *ret = dst;
|
|
char *p = dst;
|
|
const char *q = src;
|
|
while (n--)
|
|
*p++ = *q++;
|
|
return ret;
|
|
}
|
|
|
|
int32_t memcmp(uint8_t *s1, uint8_t *s2, uint32_t n)
|
|
{
|
|
while (n--)
|
|
{
|
|
if (*s1 != *s2)
|
|
return 0;
|
|
s1++;
|
|
s2++;
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
void* memclr(const void * const m_start, const size_t m_count)
|
|
{
|
|
if (sse_initialized > 0)
|
|
{
|
|
return memclr_sse2(m_start, m_count);
|
|
}
|
|
|
|
return memset(m_start, '\0', (uint32_t)m_count);
|
|
}
|
|
|
|
int32_t isspace(char c)
|
|
{
|
|
return c == ' ' || c == '\t' || c == '\n' || c == '\v' || c == '\f' || c == '\r';
|
|
}
|
|
|
|
int32_t isalpha(char c)
|
|
{
|
|
return (((c >= 'A') && (c <= 'Z')) || ((c >= 'a') && (c <= 'z')));
|
|
}
|
|
|
|
int32_t ischar(int32_t c)
|
|
{
|
|
return ((c >= 32) && (c <= 126));
|
|
}
|
|
|
|
char upper(char c)
|
|
{
|
|
if ((c >= 'a') && (c <= 'z'))
|
|
return (c - 32);
|
|
return c;
|
|
}
|
|
|
|
char toupper(char c)
|
|
{
|
|
if ((c >= 'a') && (c <= 'z'))
|
|
{
|
|
return (c - 32);
|
|
}
|
|
return c;
|
|
}
|
|
|
|
char lower(char c)
|
|
{
|
|
if ((c >= 'A') && (c <= 'Z'))
|
|
return (c + 32);
|
|
return c;
|
|
}
|