memory_wrapper.c

#include "config.h"
#define __NO_VERSION__
#ifdef CONFIG_HAVE_DEPRECATED_CONFIG_H
#include <linux/autoconf.h>
#else
#include <linux/config.h>
#endif
#include <linux/version.h>

#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0)
#if defined(CONFIG_MODVERSIONS) && !defined(__GENKSYMS__) && !defined(__DEPEND__)
#include "sndversions.h"
#endif
#endif

#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 0)
#include <linux/ioport.h>
static inline void snd_memory_wrapper_request_region(unsigned long from, unsigned long extent, const char *name)
{
      request_region(from, extent, name);
}
#endif

#undef CONFIG_SND_DEBUG_MEMORY
#include "adriver.h"
#include <linux/mm.h>

#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 4, 0)
#include <sound/memalloc.h>
#include "pci_compat_22.c"
#endif

/* vmalloc_to_page wrapper */
#ifndef CONFIG_HAVE_VMALLOC_TO_PAGE
#include <linux/highmem.h>
struct page *snd_compat_vmalloc_to_page(void *pageptr)
{
      pgd_t *pgd;
      pmd_t *pmd;
      pte_t *pte;
      unsigned long lpage;
      struct page *page;

      lpage = VMALLOC_VMADDR(pageptr);
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
      spin_lock(&init_mm.page_table_lock);
#endif
      pgd = pgd_offset(&init_mm, lpage);
      pmd = pmd_offset(pgd, lpage);
      pte = pte_offset(pmd, lpage);
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,4,0)
      page = virt_to_page(pte_page(*pte));
#else
      page = pte_page(*pte);
#endif
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,0)
      spin_unlock(&init_mm.page_table_lock);
#endif

      return page;
}    
#endif

#ifndef CONFIG_HAVE_STRLCPY
size_t snd_compat_strlcpy(char *dest, const char *src, size_t size)
{
      size_t ret = strlen(src);

      if (size) {
            size_t len = (ret >= size) ? size-1 : ret;
            memcpy(dest, src, len);
            dest[len] = '\0';
      }
      return ret;
}
#endif

#ifndef CONFIG_HAVE_VSNPRINTF
/* copied from lib/vsprintf.c from recent kernel tree */
#define ZEROPAD   1           /* pad with zero */
#define SIGN      2           /* unsigned/signed long */
#define PLUS      4           /* show plus */
#define SPACE     8           /* space if plus */
#define LEFT      16          /* left justified */
#undef SPECIAL
#define SPECIAL   32          /* 0x */
#undef LARGE
#define LARGE     64          /* use 'ABCDEF' instead of 'abcdef' */

/* we use this so that we can do without the ctype library */
#undef isdigit
#define isdigit(c)      ((c) >= '0' && (c) <= '9')

static int skip_atoi(const char **s)
{
      int i=0;

      while (isdigit(**s))
            i = i*10 + *((*s)++) - '0';
      return i;
}

static char * number(char * buf, char * end, unsigned long long num, int base, int size, int precision, int type)
{
      char c,sign,tmp[66];
      const char *digits;
      static const char small_digits[] = "0123456789abcdefghijklmnopqrstuvwxyz";
      static const char large_digits[] = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
      int i;

      digits = (type & LARGE) ? large_digits : small_digits;
      if (type & LEFT)
            type &= ~ZEROPAD;
      if (base < 2 || base > 36)
            return NULL;
      c = (type & ZEROPAD) ? '0' : ' ';
      sign = 0;
      if (type & SIGN) {
            if ((signed long long) num < 0) {
                  sign = '-';
                  num = - (signed long long) num;
                  size--;
            } else if (type & PLUS) {
                  sign = '+';
                  size--;
            } else if (type & SPACE) {
                  sign = ' ';
                  size--;
            }
      }
      if (type & SPECIAL) {
            if (base == 16)
                  size -= 2;
            else if (base == 8)
                  size--;
      }
      i = 0;
      if (num == 0)
            tmp[i++]='0';
      else while (num != 0)
            tmp[i++] = digits[do_div(num,base)];
      if (i > precision)
            precision = i;
      size -= precision;
      if (!(type&(ZEROPAD+LEFT))) {
            while(size-->0) {
                  if (buf < end)
                        *buf = ' ';
                  ++buf;
            }
      }
      if (sign) {
            if (buf < end)
                  *buf = sign;
            ++buf;
      }
      if (type & SPECIAL) {
            if (base==8) {
                  if (buf < end)
                        *buf = '0';
                  ++buf;
            } else if (base==16) {
                  if (buf < end)
                        *buf = '0';
                  ++buf;
                  if (buf < end)
                        *buf = digits[33];
                  ++buf;
            }
      }
      if (!(type & LEFT)) {
            while (size-- > 0) {
                  if (buf < end)
                        *buf = c;
                  ++buf;
            }
      }
      while (i < precision--) {
            if (buf < end)
                  *buf = '0';
            ++buf;
      }
      while (i-- > 0) {
            if (buf < end)
                  *buf = tmp[i];
            ++buf;
      }
      while (size-- > 0) {
            if (buf < end)
                  *buf = ' ';
            ++buf;
      }
      return buf;
}

int snd_compat_vsnprintf(char *buf, size_t size, const char *fmt, va_list args)
{
      int len;
      unsigned long long num;
      int i, base;
      char *str, *end, c;
      const char *s;

      int flags;        /* flags to number() */

      int field_width;  /* width of output field */
      int precision;          /* min. # of digits for integers; max
                           number of chars for from string */
      int qualifier;          /* 'h', 'l', or 'L' for integer fields */
                        /* 'z' support added 23/7/1999 S.H.    */
                        /* 'z' changed to 'Z' --davidm 1/25/99 */
                        /* 't' added for ptrdiff_t */

      /* Reject out-of-range values early.  Large positive sizes are
         used for unknown buffer sizes. */
      if (unlikely((int) size < 0))
            return 0;

      str = buf;
      end = buf + size;

      /* Make sure end is always >= buf */
      if (end < buf) {
            end = ((void *)-1);
            size = end - buf;
      }

      for (; *fmt ; ++fmt) {
            if (*fmt != '%') {
                  if (str < end)
                        *str = *fmt;
                  ++str;
                  continue;
            }

            /* process flags */
            flags = 0;
            repeat:
                  ++fmt;            /* this also skips first '%' */
                  switch (*fmt) {
                        case '-': flags |= LEFT; goto repeat;
                        case '+': flags |= PLUS; goto repeat;
                        case ' ': flags |= SPACE; goto repeat;
                        case '#': flags |= SPECIAL; goto repeat;
                        case '0': flags |= ZEROPAD; goto repeat;
                  }

            /* get field width */
            field_width = -1;
            if (isdigit(*fmt))
                  field_width = skip_atoi(&fmt);
            else if (*fmt == '*') {
                  ++fmt;
                  /* it's the next argument */
                  field_width = va_arg(args, int);
                  if (field_width < 0) {
                        field_width = -field_width;
                        flags |= LEFT;
                  }
            }

            /* get the precision */
            precision = -1;
            if (*fmt == '.') {
                  ++fmt;      
                  if (isdigit(*fmt))
                        precision = skip_atoi(&fmt);
                  else if (*fmt == '*') {
                        ++fmt;
                        /* it's the next argument */
                        precision = va_arg(args, int);
                  }
                  if (precision < 0)
                        precision = 0;
            }

            /* get the conversion qualifier */
            qualifier = -1;
            if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' ||
                *fmt =='Z' || *fmt == 'z' || *fmt == 't') {
                  qualifier = *fmt;
                  ++fmt;
                  if (qualifier == 'l' && *fmt == 'l') {
                        qualifier = 'L';
                        ++fmt;
                  }
            }

            /* default base */
            base = 10;

            switch (*fmt) {
                  case 'c':
                        if (!(flags & LEFT)) {
                              while (--field_width > 0) {
                                    if (str < end)
                                          *str = ' ';
                                    ++str;
                              }
                        }
                        c = (unsigned char) va_arg(args, int);
                        if (str < end)
                              *str = c;
                        ++str;
                        while (--field_width > 0) {
                              if (str < end)
                                    *str = ' ';
                              ++str;
                        }
                        continue;

                  case 's':
                        s = va_arg(args, char *);
                        if ((unsigned long)s < PAGE_SIZE)
                              s = "<NULL>";

                        len = strnlen(s, precision);

                        if (!(flags & LEFT)) {
                              while (len < field_width--) {
                                    if (str < end)
                                          *str = ' ';
                                    ++str;
                              }
                        }
                        for (i = 0; i < len; ++i) {
                              if (str < end)
                                    *str = *s;
                              ++str; ++s;
                        }
                        while (len < field_width--) {
                              if (str < end)
                                    *str = ' ';
                              ++str;
                        }
                        continue;

                  case 'p':
                        if (field_width == -1) {
                              field_width = 2*sizeof(void *);
                              flags |= ZEROPAD;
                        }
                        str = number(str, end,
                                    (unsigned long) va_arg(args, void *),
                                    16, field_width, precision, flags);
                        continue;


                  case 'n':
                        /* FIXME:
                        * What does C99 say about the overflow case here? */
                        if (qualifier == 'l') {
                              long * ip = va_arg(args, long *);
                              *ip = (str - buf);
                        } else if (qualifier == 'Z' || qualifier == 'z') {
                              size_t * ip = va_arg(args, size_t *);
                              *ip = (str - buf);
                        } else {
                              int * ip = va_arg(args, int *);
                              *ip = (str - buf);
                        }
                        continue;

                  case '%':
                        if (str < end)
                              *str = '%';
                        ++str;
                        continue;

                        /* integer number formats - set up the flags and "break" */
                  case 'o':
                        base = 8;
                        break;

                  case 'X':
                        flags |= LARGE;
                  case 'x':
                        base = 16;
                        break;

                  case 'd':
                  case 'i':
                        flags |= SIGN;
                  case 'u':
                        break;

                  default:
                        if (str < end)
                              *str = '%';
                        ++str;
                        if (*fmt) {
                              if (str < end)
                                    *str = *fmt;
                              ++str;
                        } else {
                              --fmt;
                        }
                        continue;
            }
            if (qualifier == 'L')
                  num = va_arg(args, long long);
            else if (qualifier == 'l') {
                  num = va_arg(args, unsigned long);
                  if (flags & SIGN)
                        num = (signed long) num;
            } else if (qualifier == 'Z' || qualifier == 'z') {
                  num = va_arg(args, size_t);
            } else if (qualifier == 't') {
                  num = va_arg(args, ptrdiff_t);
            } else if (qualifier == 'h') {
                  num = (unsigned short) va_arg(args, int);
                  if (flags & SIGN)
                        num = (signed short) num;
            } else {
                  num = va_arg(args, unsigned int);
                  if (flags & SIGN)
                        num = (signed int) num;
            }
            str = number(str, end, num, base,
                        field_width, precision, flags);
      }
      if (size > 0) {
            if (str < end)
                  *str = '\0';
            else
                  end[-1] = '\0';
      }
      /* the trailing null byte doesn't count towards the total */
      return str-buf;
}
#endif

#ifndef CONFIG_HAVE_SNPRINTF
int snd_compat_snprintf(char *buf, size_t size, const char * fmt, ...)
{
      int res;
      va_list args;

      va_start(args, fmt);
      res = vsnprintf(buf, size, fmt, args);
      va_end(args);
      return res;
}
#endif