|
@@ -15,180 +15,10 @@
|
|
|
#include "csr_pmem.h"
|
|
|
#include "csr_util.h"
|
|
|
|
|
|
-/*------------------------------------------------------------------*/
|
|
|
-/* Bits */
|
|
|
-/*------------------------------------------------------------------*/
|
|
|
-
|
|
|
-/* Time proportional with the number of 1's */
|
|
|
-u8 CsrBitCountSparse(u32 n)
|
|
|
-{
|
|
|
- u8 count = 0;
|
|
|
-
|
|
|
- while (n)
|
|
|
- {
|
|
|
- count++;
|
|
|
- n &= (n - 1);
|
|
|
- }
|
|
|
-
|
|
|
- return count;
|
|
|
-}
|
|
|
-
|
|
|
-/* Time proportional with the number of 0's */
|
|
|
-u8 CsrBitCountDense(u32 n)
|
|
|
-{
|
|
|
- u8 count = 8 * sizeof(u32);
|
|
|
-
|
|
|
- n ^= (u32) (-1);
|
|
|
-
|
|
|
- while (n)
|
|
|
- {
|
|
|
- count--;
|
|
|
- n &= (n - 1);
|
|
|
- }
|
|
|
-
|
|
|
- return count;
|
|
|
-}
|
|
|
-
|
|
|
/*------------------------------------------------------------------*/
|
|
|
/* Base conversion */
|
|
|
/*------------------------------------------------------------------*/
|
|
|
-u8 CsrHexStrToUint8(const char *string, u8 *returnValue)
|
|
|
-{
|
|
|
- u16 currentIndex = 0;
|
|
|
- *returnValue = 0;
|
|
|
- if ((string[currentIndex] == '0') && (CSR_TOUPPER(string[currentIndex + 1]) == 'X'))
|
|
|
- {
|
|
|
- string += 2;
|
|
|
- }
|
|
|
- if (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- while (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- *returnValue = (u8) (*returnValue * 16 + (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) ? string[currentIndex] - '0' : CSR_TOUPPER(string[currentIndex]) - 'A' + 10));
|
|
|
- currentIndex++;
|
|
|
- if (currentIndex >= 2)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- return TRUE;
|
|
|
- }
|
|
|
- return FALSE;
|
|
|
-}
|
|
|
-
|
|
|
-u8 CsrHexStrToUint16(const char *string, u16 *returnValue)
|
|
|
-{
|
|
|
- u16 currentIndex = 0;
|
|
|
- *returnValue = 0;
|
|
|
- if ((string[currentIndex] == '0') && (CSR_TOUPPER(string[currentIndex + 1]) == 'X'))
|
|
|
- {
|
|
|
- string += 2;
|
|
|
- }
|
|
|
- if (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- while (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- *returnValue = (u16) (*returnValue * 16 + (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) ? string[currentIndex] - '0' : CSR_TOUPPER(string[currentIndex]) - 'A' + 10));
|
|
|
- currentIndex++;
|
|
|
- if (currentIndex >= 4)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- return TRUE;
|
|
|
- }
|
|
|
- return FALSE;
|
|
|
-}
|
|
|
-
|
|
|
-u8 CsrHexStrToUint32(const char *string, u32 *returnValue)
|
|
|
-{
|
|
|
- u16 currentIndex = 0;
|
|
|
- *returnValue = 0;
|
|
|
- if ((string[currentIndex] == '0') && (CSR_TOUPPER(string[currentIndex + 1]) == 'X'))
|
|
|
- {
|
|
|
- string += 2;
|
|
|
- }
|
|
|
- if (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- while (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) || ((CSR_TOUPPER(string[currentIndex]) >= 'A') && (CSR_TOUPPER(string[currentIndex]) <= 'F')))
|
|
|
- {
|
|
|
- *returnValue = *returnValue * 16 + (((string[currentIndex] >= '0') && (string[currentIndex] <= '9')) ? string[currentIndex] - '0' : CSR_TOUPPER(string[currentIndex]) - 'A' + 10);
|
|
|
- currentIndex++;
|
|
|
- if (currentIndex >= 8)
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- return TRUE;
|
|
|
- }
|
|
|
- return FALSE;
|
|
|
-}
|
|
|
-
|
|
|
-u32 CsrPow(u32 base, u32 exponent)
|
|
|
-{
|
|
|
- if (exponent == 0)
|
|
|
- {
|
|
|
- return 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- u32 i, t = base;
|
|
|
-
|
|
|
- for (i = 1; i < exponent; i++)
|
|
|
- {
|
|
|
- t = t * base;
|
|
|
- }
|
|
|
- return t;
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
/* Convert signed 32 bit (or less) integer to string */
|
|
|
-#define I2B10_MAX 12
|
|
|
-void CsrIntToBase10(s32 number, char *str)
|
|
|
-{
|
|
|
- s32 digit;
|
|
|
- u8 index;
|
|
|
- char res[I2B10_MAX];
|
|
|
- u8 foundDigit = FALSE;
|
|
|
-
|
|
|
- for (digit = 0; digit < I2B10_MAX; digit++)
|
|
|
- {
|
|
|
- res[digit] = '\0';
|
|
|
- }
|
|
|
-
|
|
|
- /* Catch sign - and deal with positive numbers only afterwards */
|
|
|
- index = 0;
|
|
|
- if (number < 0)
|
|
|
- {
|
|
|
- res[index++] = '-';
|
|
|
- number = -1 * number;
|
|
|
- }
|
|
|
-
|
|
|
- digit = 1000000000;
|
|
|
- if (number > 0)
|
|
|
- {
|
|
|
- while ((index < I2B10_MAX - 1) && (digit > 0))
|
|
|
- {
|
|
|
- /* If the foundDigit flag is TRUE, this routine should be proceeded.
|
|
|
- Otherwise the number which has '0' digit cannot be converted correctly */
|
|
|
- if (((number / digit) > 0) || foundDigit)
|
|
|
- {
|
|
|
- foundDigit = TRUE; /* set foundDigit flag to TRUE*/
|
|
|
- res[index++] = (char) ('0' + (number / digit));
|
|
|
- number = number % digit;
|
|
|
- }
|
|
|
-
|
|
|
- digit = digit / 10;
|
|
|
- }
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- res[index] = (char) '0';
|
|
|
- }
|
|
|
-
|
|
|
- CsrStrCpy(str, res);
|
|
|
-}
|
|
|
-
|
|
|
void CsrUInt16ToHex(u16 number, char *str)
|
|
|
{
|
|
|
u16 index;
|
|
@@ -203,20 +33,6 @@ void CsrUInt16ToHex(u16 number, char *str)
|
|
|
str[4] = '\0';
|
|
|
}
|
|
|
|
|
|
-void CsrUInt32ToHex(u32 number, char *str)
|
|
|
-{
|
|
|
- u16 index;
|
|
|
- u32 currentValue;
|
|
|
-
|
|
|
- for (index = 0; index < 8; index++)
|
|
|
- {
|
|
|
- currentValue = (u32) (number & 0x0000000F);
|
|
|
- number >>= 4;
|
|
|
- str[7 - index] = (char) (currentValue > 9 ? currentValue + 55 : currentValue + '0');
|
|
|
- }
|
|
|
- str[8] = '\0';
|
|
|
-}
|
|
|
-
|
|
|
/*------------------------------------------------------------------*/
|
|
|
/* String */
|
|
|
/*------------------------------------------------------------------*/
|
|
@@ -244,19 +60,6 @@ s32 CsrMemCmp(const void *buf1, const void *buf2, size_t count)
|
|
|
return memcmp(buf1, buf2, count);
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(CsrMemCmp);
|
|
|
-
|
|
|
-void *CsrMemDup(const void *buf1, size_t count)
|
|
|
-{
|
|
|
- void *buf2 = NULL;
|
|
|
-
|
|
|
- if (buf1)
|
|
|
- {
|
|
|
- buf2 = CsrPmemAlloc(count);
|
|
|
- CsrMemCpy(buf2, buf1, count);
|
|
|
- }
|
|
|
-
|
|
|
- return buf2;
|
|
|
-}
|
|
|
#endif
|
|
|
|
|
|
#ifndef CSR_USE_STDC_LIB
|
|
@@ -270,21 +73,6 @@ char *CsrStrNCpy(char *dest, const char *src, size_t count)
|
|
|
return strncpy(dest, src, count);
|
|
|
}
|
|
|
|
|
|
-char *CsrStrCat(char *dest, const char *src)
|
|
|
-{
|
|
|
- return strcat(dest, src);
|
|
|
-}
|
|
|
-
|
|
|
-char *CsrStrNCat(char *dest, const char *src, size_t count)
|
|
|
-{
|
|
|
- return strncat(dest, src, count);
|
|
|
-}
|
|
|
-
|
|
|
-char *CsrStrStr(const char *string1, const char *string2)
|
|
|
-{
|
|
|
- return strstr(string1, string2);
|
|
|
-}
|
|
|
-
|
|
|
size_t CsrStrLen(const char *string)
|
|
|
{
|
|
|
return strlen(string);
|
|
@@ -313,39 +101,6 @@ s32 CsrVsnprintf(char *string, size_t count, const char *format, va_list args)
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(CsrVsnprintf);
|
|
|
|
|
|
-char *CsrStrNCpyZero(char *dest,
|
|
|
- const char *src,
|
|
|
- size_t count)
|
|
|
-{
|
|
|
- CsrStrNCpy(dest, src, count - 1);
|
|
|
- dest[count - 1] = '\0';
|
|
|
- return dest;
|
|
|
-}
|
|
|
-
|
|
|
-/* Convert string with base 10 to integer */
|
|
|
-u32 CsrStrToInt(const char *str)
|
|
|
-{
|
|
|
- s16 i;
|
|
|
- u32 res;
|
|
|
- u32 digit;
|
|
|
-
|
|
|
- res = 0;
|
|
|
- digit = 1;
|
|
|
-
|
|
|
- /* Start from the string end */
|
|
|
- for (i = (u16) (CsrStrLen(str) - 1); i >= 0; i--)
|
|
|
- {
|
|
|
- /* Only convert numbers */
|
|
|
- if ((str[i] >= '0') && (str[i] <= '9'))
|
|
|
- {
|
|
|
- res += digit * (str[i] - '0');
|
|
|
- digit = digit * 10;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return res;
|
|
|
-}
|
|
|
-
|
|
|
char *CsrStrDup(const char *string)
|
|
|
{
|
|
|
char *copy;
|
|
@@ -361,82 +116,6 @@ char *CsrStrDup(const char *string)
|
|
|
return copy;
|
|
|
}
|
|
|
|
|
|
-int CsrStrNICmp(const char *string1,
|
|
|
- const char *string2,
|
|
|
- size_t count)
|
|
|
-{
|
|
|
- u32 index;
|
|
|
- int returnValue = 0;
|
|
|
-
|
|
|
- for (index = 0; index < count; index++)
|
|
|
- {
|
|
|
- if (CSR_TOUPPER(string1[index]) != CSR_TOUPPER(string2[index]))
|
|
|
- {
|
|
|
- if (CSR_TOUPPER(string1[index]) > CSR_TOUPPER(string2[index]))
|
|
|
- {
|
|
|
- returnValue = 1;
|
|
|
- }
|
|
|
- else
|
|
|
- {
|
|
|
- returnValue = -1;
|
|
|
- }
|
|
|
- break;
|
|
|
- }
|
|
|
- if (string1[index] == '\0')
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- return returnValue;
|
|
|
-}
|
|
|
-
|
|
|
-const char *CsrGetBaseName(const char *file)
|
|
|
-{
|
|
|
- const char *pch;
|
|
|
- static const char dotDir[] = ".";
|
|
|
-
|
|
|
- if (!file)
|
|
|
- {
|
|
|
- return NULL;
|
|
|
- }
|
|
|
-
|
|
|
- if (file[0] == '\0')
|
|
|
- {
|
|
|
- return dotDir;
|
|
|
- }
|
|
|
-
|
|
|
- pch = file + CsrStrLen(file) - 1;
|
|
|
-
|
|
|
- while (*pch != '\\' && *pch != '/' && *pch != ':')
|
|
|
- {
|
|
|
- if (pch == file)
|
|
|
- {
|
|
|
- return pch;
|
|
|
- }
|
|
|
- --pch;
|
|
|
- }
|
|
|
-
|
|
|
- return ++pch;
|
|
|
-}
|
|
|
-
|
|
|
-/*------------------------------------------------------------------*/
|
|
|
-/* Misc */
|
|
|
-/*------------------------------------------------------------------*/
|
|
|
-u8 CsrIsSpace(u8 c)
|
|
|
-{
|
|
|
- switch (c)
|
|
|
- {
|
|
|
- case '\t':
|
|
|
- case '\n':
|
|
|
- case '\f':
|
|
|
- case '\r':
|
|
|
- case ' ':
|
|
|
- return TRUE;
|
|
|
- default:
|
|
|
- return FALSE;
|
|
|
- }
|
|
|
-}
|
|
|
-
|
|
|
MODULE_DESCRIPTION("CSR Operating System Kernel Abstraction");
|
|
|
MODULE_AUTHOR("Cambridge Silicon Radio Ltd.");
|
|
|
MODULE_LICENSE("GPL and additional rights");
|