/* Copyright (C) Yuri Dario & 2000 MySQL AB
   All the above parties has a full, independent copyright to
   the following code, including the right to use the code in
   any manner without any demands from the other parties.

   This library is free software; you can redistribute it and/or
   modify it under the terms of the GNU Library General Public
   License as published by the Free Software Foundation; either
   version 2 of the License, or (at your option) any later version.

   This library 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
   Library General Public License for more details.

   You should have received a copy of the GNU Library General Public
   License along with this library; if not, write to the Free
   Software Foundation, Inc., 59 Temple Place - Suite 330, Boston,
   MA 02111-1307, USA */

DWORD    TlsAlloc( void);
BOOL     TlsFree( DWORD);
PVOID    TlsGetValue( DWORD);
BOOL     TlsSetValue( DWORD, PVOID);

#define TLS_MINIMUM_AVAILABLE   64


PULONG           tls_storage;   /* TLS local storage */
DWORD            tls_bits[2];   /* TLS in-use bits   */
pthread_mutex_t  tls_mutex;     /* TLS mutex for in-use bits */

DWORD    TlsAlloc( void)
{
   DWORD index = -1;
   DWORD mask, tibidx;
   int   i;

   if (tls_storage == NULL) {

      APIRET rc;

      // allocate memory for TLS storage
      rc = DosAllocThreadLocalMemory( 1, &tls_storage);
      if (rc) {
         fprintf( stderr, "DosAllocThreadLocalMemory error: return code = %u\n", rc);
      }

      // create a mutex
      if (pthread_mutex_init( &tls_mutex, NULL))
         fprintf( stderr, "Failed to init TLS mutex\n");
   }

   pthread_mutex_lock( &tls_mutex);

   tibidx = 0;
   if (tls_bits[0] == 0xFFFFFFFF) {
      if (tls_bits[1] == 0xFFFFFFFF) {
            fprintf( stderr, "tid#%d, no more TLS bits available\n", _threadid);
            pthread_mutex_unlock( &tls_mutex);
            return -1;
      }
      tibidx = 1;
   }
   for( i=0; i<32; i++) {
      mask = (1 << i);
      if ((tls_bits[ tibidx] & mask) == 0) {
         tls_bits[ tibidx] |= mask;
         index = (tibidx*32) + i;
         break;
      }
   }
   tls_storage[index] = 0;

   pthread_mutex_unlock( &tls_mutex);

   //fprintf( stderr, "tid#%d, TlsAlloc index %d\n", _threadid, index);

   return index;
}

BOOL     TlsFree( DWORD index)
{
   int    tlsidx;
   DWORD  mask;

   if (index >= TLS_MINIMUM_AVAILABLE)
      return NULL;

   pthread_mutex_lock( &tls_mutex);

   tlsidx = 0;
   if (index > 32) {
      tlsidx++;
   }
   mask = (1 << index);
   if (tls_bits[ tlsidx] & mask) {
      tls_bits[tlsidx] &= ~mask;
      tls_storage[index] = 0;
      pthread_mutex_unlock( &tls_mutex);
      return TRUE;
   }

   pthread_mutex_unlock( &tls_mutex);
   return FALSE;
}


PVOID    TlsGetValue( DWORD index)
{
   if (index >= TLS_MINIMUM_AVAILABLE)
      return NULL;

   // verify if memory has been allocated for this thread
   if (*tls_storage == NULL) {
      // allocate memory for indexes
      *tls_storage = (ULONG)calloc( TLS_MINIMUM_AVAILABLE, sizeof(int));
      //fprintf( stderr, "tid#%d, tls_storage %x\n", _threadid, *tls_storage);
   }

   ULONG* tls_array = (ULONG*) *tls_storage;
   return (PVOID) tls_array[ index];
}

BOOL     TlsSetValue( DWORD index, PVOID val)
{

   // verify if memory has been allocated for this thread
   if (*tls_storage == NULL) {
      // allocate memory for indexes
      *tls_storage = (ULONG)calloc( TLS_MINIMUM_AVAILABLE, sizeof(int));
      //fprintf( stderr, "tid#%d, tls_storage %x\n", _threadid, *tls_storage);
   }

   if (index >= TLS_MINIMUM_AVAILABLE)
      return FALSE;

   ULONG* tls_array = (ULONG*) *tls_storage;
   //fprintf( stderr, "tid#%d, TlsSetValue array %08x index %d -> %08x (old)\n", _threadid, tls_array, index, tls_array[ index]);
   tls_array[ index] = (ULONG) val;
   //fprintf( stderr, "tid#%d, TlsSetValue array %08x index %d -> %08x\n", _threadid, tls_array, index, val);

   return TRUE;
}