2007-10-29 16:20:45 +00:00
|
|
|
/**************************************************************************
|
|
|
|
*
|
|
|
|
* Copyright 2007 Tungsten Graphics, Inc., Cedar Park, Texas.
|
|
|
|
* All Rights Reserved.
|
|
|
|
*
|
2007-08-13 16:24:24 +01:00
|
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
2007-10-29 16:20:45 +00:00
|
|
|
* copy of this software and associated documentation files (the
|
|
|
|
* "Software"), to deal in the Software without restriction, including
|
|
|
|
* without limitation the rights to use, copy, modify, merge, publish,
|
|
|
|
* distribute, sub license, and/or sell copies of the Software, and to
|
|
|
|
* permit persons to whom the Software is furnished to do so, subject to
|
|
|
|
* the following conditions:
|
|
|
|
*
|
|
|
|
* The above copyright notice and this permission notice (including the
|
|
|
|
* next paragraph) shall be included in all copies or substantial portions
|
|
|
|
* of the Software.
|
|
|
|
*
|
2007-08-13 16:24:24 +01:00
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
|
2007-10-29 16:20:45 +00:00
|
|
|
* OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
|
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
|
|
|
|
* IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
|
|
|
|
* ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
|
|
|
|
* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
|
|
|
|
* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
|
|
|
*
|
|
|
|
**************************************************************************/
|
2007-08-13 16:24:24 +01:00
|
|
|
|
|
|
|
#ifndef P_UTIL_H
|
|
|
|
#define P_UTIL_H
|
|
|
|
|
|
|
|
#include "p_compiler.h"
|
2008-02-06 16:48:37 +00:00
|
|
|
#include "p_debug.h"
|
2007-08-13 17:02:27 +01:00
|
|
|
#include <math.h>
|
2007-12-11 15:58:39 +00:00
|
|
|
|
2007-08-13 16:24:24 +01:00
|
|
|
|
2007-10-29 16:20:45 +00:00
|
|
|
#ifdef WIN32
|
|
|
|
|
|
|
|
#ifdef __cplusplus
|
|
|
|
extern "C"
|
|
|
|
{
|
|
|
|
#endif
|
|
|
|
|
|
|
|
void * __stdcall
|
|
|
|
EngAllocMem(
|
|
|
|
unsigned long Flags,
|
|
|
|
unsigned long MemSize,
|
|
|
|
unsigned long Tag );
|
|
|
|
|
|
|
|
void __stdcall
|
|
|
|
EngFreeMem(
|
|
|
|
void *Mem );
|
|
|
|
|
|
|
|
#ifdef __cplusplus
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static INLINE void *
|
|
|
|
MALLOC( unsigned size )
|
|
|
|
{
|
|
|
|
return EngAllocMem( 0, size, 'D3AG' );
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE void *
|
|
|
|
CALLOC( unsigned count, unsigned size )
|
|
|
|
{
|
|
|
|
void *ptr = MALLOC( count * size );
|
|
|
|
if( ptr ) {
|
|
|
|
memset( ptr, 0, count * size );
|
|
|
|
}
|
|
|
|
return ptr;
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE void
|
|
|
|
FREE( void *ptr )
|
|
|
|
{
|
|
|
|
if( ptr ) {
|
|
|
|
EngFreeMem( ptr );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE void *
|
|
|
|
REALLOC( void *old_ptr, unsigned old_size, unsigned new_size )
|
|
|
|
{
|
|
|
|
void *new_ptr;
|
|
|
|
if( new_size <= old_size ) {
|
|
|
|
return old_ptr;
|
|
|
|
}
|
|
|
|
new_ptr = MALLOC( new_size );
|
|
|
|
if( new_ptr ) {
|
|
|
|
memcpy( new_ptr, old_ptr, old_size );
|
|
|
|
}
|
|
|
|
FREE( old_ptr );
|
|
|
|
return new_ptr;
|
|
|
|
}
|
|
|
|
|
|
|
|
#define GETENV( X ) NULL
|
|
|
|
|
2007-12-11 15:58:39 +00:00
|
|
|
#else /* WIN32 */
|
2007-08-13 16:24:24 +01:00
|
|
|
|
2007-10-28 16:36:07 +00:00
|
|
|
#define MALLOC( SIZE ) malloc( SIZE )
|
|
|
|
|
2007-10-29 16:20:45 +00:00
|
|
|
#define CALLOC( COUNT, SIZE ) calloc( COUNT, SIZE )
|
|
|
|
|
2007-10-27 18:53:38 +01:00
|
|
|
#define FREE( PTR ) free( PTR )
|
|
|
|
|
2007-10-29 16:20:45 +00:00
|
|
|
#define REALLOC( OLDPTR, OLDSIZE, NEWSIZE ) realloc( OLDPTR, NEWSIZE )
|
|
|
|
|
|
|
|
#define GETENV( X ) getenv( X )
|
|
|
|
|
2007-12-11 15:58:39 +00:00
|
|
|
#endif /* WIN32 */
|
2007-10-29 16:20:45 +00:00
|
|
|
|
2008-01-25 10:33:58 +00:00
|
|
|
#define MALLOC_STRUCT(T) (struct T *) MALLOC(sizeof(struct T))
|
|
|
|
|
2007-10-29 16:20:45 +00:00
|
|
|
#define CALLOC_STRUCT(T) (struct T *) CALLOC(1, sizeof(struct T))
|
|
|
|
|
2007-12-11 15:58:39 +00:00
|
|
|
|
2008-01-17 04:39:14 +00:00
|
|
|
/**
|
|
|
|
* Return a pointer aligned to next multiple of N bytes.
|
|
|
|
*/
|
|
|
|
static INLINE void *
|
|
|
|
align_pointer( void *unaligned, uint alignment )
|
|
|
|
{
|
|
|
|
if (sizeof(void *) == 64) {
|
|
|
|
union {
|
|
|
|
void *p;
|
|
|
|
uint64 u;
|
|
|
|
} pu;
|
|
|
|
pu.p = unaligned;
|
|
|
|
pu.u = (pu.u + alignment - 1) & ~(uint64) (alignment - 1);
|
|
|
|
return pu.p;
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
/* 32-bit pointers */
|
|
|
|
union {
|
|
|
|
void *p;
|
|
|
|
uint u;
|
|
|
|
} pu;
|
|
|
|
pu.p = unaligned;
|
|
|
|
pu.u = (pu.u + alignment - 1) & ~(alignment - 1);
|
|
|
|
return pu.p;
|
|
|
|
}
|
|
|
|
}
|
2007-12-11 15:58:39 +00:00
|
|
|
|
|
|
|
/**
|
|
|
|
* Return memory on given byte alignment
|
|
|
|
*/
|
|
|
|
static INLINE void *
|
2007-12-11 16:09:06 +00:00
|
|
|
align_malloc(size_t bytes, uint alignment)
|
2007-12-11 15:58:39 +00:00
|
|
|
{
|
|
|
|
#if defined(HAVE_POSIX_MEMALIGN)
|
|
|
|
void *mem;
|
|
|
|
(void) posix_memalign(& mem, alignment, bytes);
|
|
|
|
return mem;
|
|
|
|
#else
|
2008-01-17 04:39:14 +00:00
|
|
|
char *ptr, *buf;
|
2007-12-11 15:58:39 +00:00
|
|
|
|
|
|
|
assert( alignment > 0 );
|
|
|
|
|
2008-01-17 04:39:14 +00:00
|
|
|
ptr = (char *) MALLOC(bytes + alignment + sizeof(void *));
|
2007-12-11 15:58:39 +00:00
|
|
|
if (!ptr)
|
|
|
|
return NULL;
|
|
|
|
|
2008-01-17 04:39:14 +00:00
|
|
|
buf = (char *) align_pointer( ptr + sizeof(void *), alignment );
|
|
|
|
*(char **)(buf - sizeof(void *)) = ptr;
|
2007-12-11 15:58:39 +00:00
|
|
|
|
2008-01-17 04:39:14 +00:00
|
|
|
return buf;
|
2007-12-11 15:58:39 +00:00
|
|
|
#endif /* defined(HAVE_POSIX_MEMALIGN) */
|
|
|
|
}
|
|
|
|
|
|
|
|
/**
|
|
|
|
* Free memory returned by align_malloc().
|
|
|
|
*/
|
|
|
|
static INLINE void
|
|
|
|
align_free(void *ptr)
|
|
|
|
{
|
|
|
|
#if defined(HAVE_POSIX_MEMALIGN)
|
|
|
|
FREE(ptr);
|
|
|
|
#else
|
|
|
|
void **cubbyHole = (void **) ((char *) ptr - sizeof(void *));
|
|
|
|
void *realAddr = *cubbyHole;
|
|
|
|
FREE(realAddr);
|
|
|
|
#endif /* defined(HAVE_POSIX_MEMALIGN) */
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
2008-02-06 16:28:20 +00:00
|
|
|
/**
|
2008-02-07 09:26:08 +00:00
|
|
|
* Duplicate a block of memory.
|
2008-02-06 16:28:20 +00:00
|
|
|
*/
|
|
|
|
static INLINE void *
|
|
|
|
mem_dup(const void *src, uint size)
|
|
|
|
{
|
2008-02-07 09:26:08 +00:00
|
|
|
void *dup = MALLOC(size);
|
2008-02-06 16:28:20 +00:00
|
|
|
if (dup)
|
|
|
|
memcpy(dup, src, size);
|
|
|
|
return dup;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
2007-08-13 16:24:24 +01:00
|
|
|
#define CLAMP( X, MIN, MAX ) ( (X)<(MIN) ? (MIN) : ((X)>(MAX) ? (MAX) : (X)) )
|
|
|
|
#define MIN2( A, B ) ( (A)<(B) ? (A) : (B) )
|
|
|
|
#define MAX2( A, B ) ( (A)>(B) ? (A) : (B) )
|
|
|
|
|
|
|
|
#define Elements(x) sizeof(x)/sizeof(*(x))
|
2007-11-21 11:04:20 +00:00
|
|
|
#define Offset(TYPE, MEMBER) ((unsigned)&(((TYPE *)NULL)->MEMBER))
|
2007-08-13 16:24:24 +01:00
|
|
|
|
2007-08-17 18:40:06 +01:00
|
|
|
/**
|
2007-08-29 21:40:18 +01:00
|
|
|
* Return a pointer aligned to next multiple of 16 bytes.
|
2007-08-17 18:40:06 +01:00
|
|
|
*/
|
|
|
|
static INLINE void *
|
2007-08-29 21:40:18 +01:00
|
|
|
align16( void *unaligned )
|
2007-08-17 18:40:06 +01:00
|
|
|
{
|
2008-01-17 04:39:14 +00:00
|
|
|
return align_pointer( unaligned, 16 );
|
2007-08-17 18:40:06 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2008-01-17 04:39:14 +00:00
|
|
|
static INLINE int align_int(int x, int align)
|
|
|
|
{
|
|
|
|
return (x + align - 1) & ~(align - 1);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
2007-08-16 19:44:53 +01:00
|
|
|
#if defined(__MSC__) && defined(__WIN32__)
|
|
|
|
static INLINE unsigned ffs( unsigned u )
|
|
|
|
{
|
|
|
|
unsigned i;
|
|
|
|
|
2007-08-29 21:40:18 +01:00
|
|
|
if( u == 0 ) {
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-08-16 19:44:53 +01:00
|
|
|
__asm bsf eax, [u]
|
2007-08-29 21:40:18 +01:00
|
|
|
__asm inc eax
|
2007-08-16 19:44:53 +01:00
|
|
|
__asm mov [i], eax
|
|
|
|
|
|
|
|
return i;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2007-08-13 16:24:24 +01:00
|
|
|
union fi {
|
|
|
|
float f;
|
|
|
|
int i;
|
|
|
|
unsigned ui;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define UBYTE_TO_FLOAT( ub ) ((float)(ub) / 255.0F)
|
|
|
|
|
|
|
|
#define IEEE_0996 0x3f7f0000 /* 0.996 or so */
|
|
|
|
|
|
|
|
/* This function/macro is sensitive to precision. Test very carefully
|
|
|
|
* if you change it!
|
|
|
|
*/
|
|
|
|
#define UNCLAMPED_FLOAT_TO_UBYTE(UB, F) \
|
|
|
|
do { \
|
|
|
|
union fi __tmp; \
|
|
|
|
__tmp.f = (F); \
|
|
|
|
if (__tmp.i < 0) \
|
|
|
|
UB = (ubyte) 0; \
|
|
|
|
else if (__tmp.i >= IEEE_0996) \
|
|
|
|
UB = (ubyte) 255; \
|
|
|
|
else { \
|
2007-08-16 12:12:14 +01:00
|
|
|
__tmp.f = __tmp.f * (255.0f/256.0f) + 32768.0f; \
|
2007-08-13 16:24:24 +01:00
|
|
|
UB = (ubyte) __tmp.i; \
|
|
|
|
} \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static INLINE unsigned pack_ub4( unsigned char b0,
|
|
|
|
unsigned char b1,
|
|
|
|
unsigned char b2,
|
|
|
|
unsigned char b3 )
|
|
|
|
{
|
|
|
|
return ((((unsigned int)b0) << 0) |
|
|
|
|
(((unsigned int)b1) << 8) |
|
|
|
|
(((unsigned int)b2) << 16) |
|
|
|
|
(((unsigned int)b3) << 24));
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE unsigned fui( float f )
|
|
|
|
{
|
|
|
|
union fi fi;
|
|
|
|
fi.f = f;
|
|
|
|
return fi.ui;
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE unsigned char float_to_ubyte( float f )
|
|
|
|
{
|
|
|
|
unsigned char ub;
|
|
|
|
UNCLAMPED_FLOAT_TO_UBYTE(ub, f);
|
|
|
|
return ub;
|
|
|
|
}
|
|
|
|
|
|
|
|
static INLINE unsigned pack_ui32_float4( float a,
|
|
|
|
float b,
|
2007-11-23 14:50:26 +00:00
|
|
|
float c,
|
|
|
|
float d )
|
2007-08-13 16:24:24 +01:00
|
|
|
{
|
|
|
|
return pack_ub4( float_to_ubyte(a),
|
|
|
|
float_to_ubyte(b),
|
|
|
|
float_to_ubyte(c),
|
|
|
|
float_to_ubyte(d) );
|
|
|
|
}
|
|
|
|
|
2007-08-13 17:02:27 +01:00
|
|
|
#define COPY_4V( DST, SRC ) \
|
|
|
|
do { \
|
|
|
|
(DST)[0] = (SRC)[0]; \
|
|
|
|
(DST)[1] = (SRC)[1]; \
|
|
|
|
(DST)[2] = (SRC)[2]; \
|
|
|
|
(DST)[3] = (SRC)[3]; \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
|
2007-08-17 01:11:55 +01:00
|
|
|
#define COPY_4FV( DST, SRC ) COPY_4V(DST, SRC)
|
|
|
|
|
|
|
|
|
|
|
|
#define ASSIGN_4V( DST, V0, V1, V2, V3 ) \
|
|
|
|
do { \
|
|
|
|
(DST)[0] = (V0); \
|
|
|
|
(DST)[1] = (V1); \
|
|
|
|
(DST)[2] = (V2); \
|
|
|
|
(DST)[3] = (V3); \
|
|
|
|
} while (0)
|
|
|
|
|
|
|
|
|
2007-08-13 17:02:27 +01:00
|
|
|
static INLINE int ifloor(float f)
|
|
|
|
{
|
|
|
|
int ai, bi;
|
|
|
|
double af, bf;
|
|
|
|
union fi u;
|
|
|
|
|
|
|
|
af = (3 << 22) + 0.5 + (double)f;
|
|
|
|
bf = (3 << 22) + 0.5 - (double)f;
|
|
|
|
u.f = (float) af; ai = u.i;
|
|
|
|
u.f = (float) bf; bi = u.i;
|
|
|
|
return (ai - bi) >> 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#if defined(__GNUC__) && defined(__i386__)
|
|
|
|
static INLINE int iround(float f)
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
__asm__ ("fistpl %0" : "=m" (r) : "t" (f) : "st");
|
|
|
|
return r;
|
|
|
|
}
|
|
|
|
#elif defined(__MSC__) && defined(__WIN32__)
|
|
|
|
static INLINE int iround(float f)
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
_asm {
|
|
|
|
fld f
|
|
|
|
fistp r
|
|
|
|
}
|
|
|
|
return r;
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
#define IROUND(f) ((int) (((f) >= 0.0F) ? ((f) + 0.5F) : ((f) - 0.5F)))
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
/* Could maybe have an inline version of this?
|
|
|
|
*/
|
|
|
|
#if defined(__GNUC__)
|
|
|
|
#define FABSF(x) fabsf(x)
|
|
|
|
#else
|
2007-08-16 19:44:53 +01:00
|
|
|
#define FABSF(x) ((float) fabs(x))
|
2007-08-13 17:02:27 +01:00
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Pretty fast, and accurate.
|
|
|
|
* Based on code from http://www.flipcode.com/totd/
|
|
|
|
*/
|
|
|
|
static INLINE float LOG2(float val)
|
|
|
|
{
|
|
|
|
union fi num;
|
|
|
|
int log_2;
|
|
|
|
|
|
|
|
num.f = val;
|
|
|
|
log_2 = ((num.i >> 23) & 255) - 128;
|
|
|
|
num.i &= ~(255 << 23);
|
|
|
|
num.i += 127 << 23;
|
|
|
|
num.f = ((-1.0f/3) * num.f + 2) * num.f - 2.0f/3;
|
|
|
|
return num.f + log_2;
|
|
|
|
}
|
|
|
|
|
2007-10-29 16:20:45 +00:00
|
|
|
#if defined(__GNUC__)
|
|
|
|
#define CEILF(x) ceilf(x)
|
|
|
|
#else
|
|
|
|
#define CEILF(x) ((float) ceil(x))
|
|
|
|
#endif
|
2007-08-13 17:02:27 +01:00
|
|
|
|
2007-12-13 20:38:56 +00:00
|
|
|
static INLINE int align(int value, int alignment)
|
|
|
|
{
|
|
|
|
return (value + alignment - 1) & ~(alignment - 1);
|
|
|
|
}
|
|
|
|
|
2008-01-18 18:08:30 +00:00
|
|
|
|
|
|
|
/* util/p_util.c
|
|
|
|
*/
|
|
|
|
extern void pipe_copy_rect(ubyte * dst, unsigned cpp, unsigned dst_pitch,
|
|
|
|
unsigned dst_x, unsigned dst_y, unsigned width,
|
|
|
|
unsigned height, const ubyte * src,
|
2008-02-13 11:39:58 +00:00
|
|
|
int src_pitch, unsigned src_x, int src_y);
|
2008-01-18 18:08:30 +00:00
|
|
|
|
|
|
|
|
2007-08-13 16:24:24 +01:00
|
|
|
#endif
|