313 lines
5.9 KiB
C
313 lines
5.9 KiB
C
/*
|
|
* Copyright (c) 1992,1993-1995 by Argonaut Technologies Limited. All rights reserved.
|
|
*
|
|
* $Id: vecfns.h 1.11 1995/06/30 16:09:04 sam Exp $
|
|
* $Locker: $
|
|
*
|
|
* Inline versions of the vector operations (could do compiler specific
|
|
* versions for compilers that support inline, ie: gcc)
|
|
*/
|
|
|
|
#ifndef _VECFNS_H_
|
|
#define _VECFNS_H_
|
|
|
|
#ifdef __cplusplus
|
|
extern "C" {
|
|
#endif
|
|
|
|
/**
|
|
** 2D VECTORS
|
|
**/
|
|
|
|
/*
|
|
* v1=v2
|
|
*/
|
|
#define BrVector2Copy(v1, v2) do {\
|
|
(v1)->v[0]=(v2)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=(s1,s2)
|
|
*/
|
|
#define BrVector2Set(v1, s1, s2) do {\
|
|
(v1)->v[0]=s1;\
|
|
(v1)->v[1]=s2;\
|
|
} while(0)
|
|
|
|
#define BrVector2SetInt(v1, i1, i2) do {\
|
|
(v1)->v[0]=BrIntToScalar(i1);\
|
|
(v1)->v[1]=BrIntToScalar(i2);\
|
|
} while(0)
|
|
|
|
#define BrVector2SetFloat(v1, f1, f2) do {\
|
|
(v1)->v[0]=BrFloatToScalar(f1);\
|
|
(v1)->v[1]=BrFloatToScalar(f2);\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=-v2
|
|
*/
|
|
#define BrVector2Negate(v1, v2) do {\
|
|
(v1)->v[0]=-(v2)->v[0];\
|
|
(v1)->v[1]=-(v2)->v[1];\
|
|
} while(0)
|
|
|
|
|
|
/*
|
|
* v1=v2+v3
|
|
*/
|
|
#define BrVector2Add(v1, v2, v3) do {\
|
|
(v1)->v[0]=(v2)->v[0]+(v3)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1]+(v3)->v[1];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1+=v2
|
|
*/
|
|
#define BrVector2Accumulate(v1, v2) do {\
|
|
(v1)->v[0]+=(v2)->v[0];\
|
|
(v1)->v[1]+=(v2)->v[1];\
|
|
}while(0)
|
|
|
|
/*
|
|
* v1+=v2*scalar
|
|
*/
|
|
#define BrVector2AccumulateScale(v1, v2, s) do {\
|
|
(v1)->v[0]+=BR_MUL((v2)->v[0],(s));\
|
|
(v1)->v[1]+=BR_MUL((v2)->v[1],(s));\
|
|
}while(0)
|
|
|
|
/*
|
|
* v1=v2-v3
|
|
*/
|
|
#define BrVector2Sub(v1, v2, v3) do {\
|
|
(v1)->v[0]=(v2)->v[0]-(v3)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1]-(v3)->v[1];\
|
|
}while(0)
|
|
|
|
/*
|
|
* v1=v2*scalar
|
|
*/
|
|
#define BrVector2Scale(v1, v2, s) do {\
|
|
(v1)->v[0]=BR_MUL((v2)->v[0],(s));\
|
|
(v1)->v[1]=BR_MUL((v2)->v[1],(s));\
|
|
}while(0)
|
|
|
|
/*
|
|
* v1=v2/scalar
|
|
*/
|
|
#define BrVector2InvScale(v1, v2, s) do {\
|
|
(v1)->v[0]=BR_DIV((v2)->v[0],(s));\
|
|
(v1)->v[1]=BR_DIV((v2)->v[1],(s));\
|
|
}while(0)
|
|
|
|
/*
|
|
* = v1.v2
|
|
*/
|
|
#define BrVector2Dot(v1, v2) BR_MAC2((v1)->v[0],(v2)->v[0],(v1)->v[1],(v2)->v[1])
|
|
|
|
/*
|
|
* = |v1|
|
|
*/
|
|
#define BrVector2Length(v1) BR_LENGTH2((v1)->v[0],(v1)->v[1])
|
|
|
|
/*
|
|
* = |v1| * |v1|
|
|
*/
|
|
#define BrVector2LengthSquared(v1) BR_SQR2((v1)->v[0],(v1)->v[1])
|
|
|
|
|
|
|
|
/**
|
|
** 3D VECTORS
|
|
**/
|
|
|
|
/*
|
|
* v1=v2
|
|
*/
|
|
#define BrVector3Copy(v1, v2) do {\
|
|
(v1)->v[0]=(v2)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1];\
|
|
(v1)->v[2]=(v2)->v[2];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=(s1,s2,s3)
|
|
*/
|
|
#define BrVector3Set(v1, s1, s2, s3) do {\
|
|
(v1)->v[0]=(s1);\
|
|
(v1)->v[1]=(s2);\
|
|
(v1)->v[2]=(s3);\
|
|
} while(0)
|
|
|
|
#define BrVector3SetInt(v1, i1, i2, i3) do {\
|
|
(v1)->v[0]=BrIntToScalar(i1);\
|
|
(v1)->v[1]=BrIntToScalar(i2);\
|
|
(v1)->v[2]=BrIntToScalar(i3);\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=-v2
|
|
*/
|
|
#define BrVector3Negate(v1, v2) do {\
|
|
(v1)->v[0]=- (v2)->v[0];\
|
|
(v1)->v[1]=-(v2)->v[1];\
|
|
(v1)->v[2]=-(v2)->v[2];\
|
|
} while(0)
|
|
|
|
|
|
/*
|
|
* v1=v2+v3
|
|
*/
|
|
#define BrVector3Add(v1, v2, v3) do {\
|
|
(v1)->v[0]=(v2)->v[0]+(v3)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1]+(v3)->v[1];\
|
|
(v1)->v[2]=(v2)->v[2]+(v3)->v[2];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1+=v2
|
|
*/
|
|
#define BrVector3Accumulate(v1, v2) do {\
|
|
(v1)->v[0]+=(v2)->v[0];\
|
|
(v1)->v[1]+=(v2)->v[1];\
|
|
(v1)->v[2]+=(v2)->v[2];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1+=v2*scalar
|
|
*/
|
|
#define BrVector3AccumulateScale(v1, v2, s) do {\
|
|
(v1)->v[0]+=BR_MUL((v2)->v[0],(s));\
|
|
(v1)->v[1]+=BR_MUL((v2)->v[1],(s));\
|
|
(v1)->v[2]+=BR_MUL((v2)->v[2],(s));\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=v2-v3
|
|
*/
|
|
#define BrVector3Sub(v1, v2, v3) do {\
|
|
(v1)->v[0]=(v2)->v[0]-(v3)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1]-(v3)->v[1];\
|
|
(v1)->v[2]=(v2)->v[2]-(v3)->v[2];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=v2*scalar
|
|
*/
|
|
#define BrVector3Scale(v1, v2, s) do {\
|
|
(v1)->v[0]=BR_MUL((v2)->v[0],(s));\
|
|
(v1)->v[1]=BR_MUL((v2)->v[1],(s));\
|
|
(v1)->v[2]=BR_MUL((v2)->v[2],(s));\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1=v2/scalar
|
|
*/
|
|
#define BrVector3InvScale(v1, v2, s) do {\
|
|
(v1)->v[0]=BR_DIV((v2)->v[0],(s));\
|
|
(v1)->v[1]=BR_DIV((v2)->v[1],(s));\
|
|
(v1)->v[2]=BR_DIV((v2)->v[2],(s));\
|
|
} while(0)
|
|
|
|
/*
|
|
* = v1.v2
|
|
*/
|
|
#define BrVector3Dot(v1, v2) BR_MAC3((v1)->v[0],(v2)->v[0],(v1)->v[1],(v2)->v[1],(v1)->v[2],(v2)->v[2])
|
|
|
|
/*
|
|
* v1 = v2 x v3
|
|
*/
|
|
#define BrVector3Cross(v1,v2,v3) do {\
|
|
(v1)->v[0]=BR_MUL((v2)->v[1],(v3)->v[2])-BR_MUL((v2)->v[2],(v3)->v[1]);\
|
|
(v1)->v[1]=BR_MUL((v2)->v[2],(v3)->v[0])-BR_MUL((v2)->v[0],(v3)->v[2]);\
|
|
(v1)->v[2]=BR_MUL((v2)->v[0],(v3)->v[1])-BR_MUL((v2)->v[1],(v3)->v[0]);\
|
|
} while(0)
|
|
|
|
/*
|
|
* = |v1|
|
|
*/
|
|
#define BrVector3Length(v1) BR_LENGTH3((v1)->v[0],(v1)->v[1],(v1)->v[2])
|
|
|
|
/*
|
|
* = |v1| * |v1|
|
|
*/
|
|
#define BrVector3LengthSquared(v1) BR_SQR3((v1)->v[0],(v1)->v[1],(v1)->v[2])
|
|
|
|
/*
|
|
* v1 = v2/|v2|
|
|
*/
|
|
#define BrVector3Normalise(v1,v2) do {\
|
|
br_scalar _scale;\
|
|
_scale = BR_LENGTH3((v2)->v[0],(v2)->v[1],(v2)->v[2]);\
|
|
if(_scale > (BR_SCALAR_EPSILON*2)) {\
|
|
_scale = BR_RCP(_scale);\
|
|
(v1)->v[0]=BR_MUL((v2)->v[0],_scale);\
|
|
(v1)->v[1]=BR_MUL((v2)->v[1],_scale);\
|
|
(v1)->v[2]=BR_MUL((v2)->v[2],_scale);\
|
|
} else {\
|
|
(v1)->v[0]=BR_FRACTION(1.0);\
|
|
(v1)->v[1]=BR_FRACTION(0.0);\
|
|
(v1)->v[2]=BR_FRACTION(0.0);\
|
|
}\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1 = v2/|v2|
|
|
*/
|
|
#define BrVector3NormaliseQuick(v1,v2) do {\
|
|
br_scalar _scale;\
|
|
_scale=BR_RCP(BR_LENGTH3((v2)->v[0],(v2)->v[1],(v2)->v[2]));\
|
|
BrVector3Scale(v1,v2,_scale);\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1 = v2/|v2| (low precision)
|
|
*/
|
|
#define BrVector3NormaliseLP(v1,v2) do {\
|
|
br_scalar _scale;\
|
|
_scale=BR_RCP(BR_LENGTH3((v2)->v[0],(v2)->v[1],(v2)->v[2]));\
|
|
BrVector3Scale(v1,v2,_scale);\
|
|
} while(0)
|
|
|
|
/*
|
|
* 4D Vectors
|
|
*/
|
|
/*
|
|
* = v1.v2
|
|
*/
|
|
#define BrVector4Dot(v1, v2) BR_MAC4((v1)->v[0],(v2)->v[0],(v1)->v[1],(v2)->v[1],(v1)->v[2],(v2)->v[2],(v1)->v[3],(v2)->v[3])
|
|
|
|
/*
|
|
* v1=v2
|
|
*/
|
|
#define BrVector4Copy(v1, v2) do {\
|
|
(v1)->v[0]=(v2)->v[0];\
|
|
(v1)->v[1]=(v2)->v[1];\
|
|
(v1)->v[2]=(v2)->v[2];\
|
|
(v1)->v[3]=(v2)->v[3];\
|
|
} while(0)
|
|
|
|
/*
|
|
* v1 = v2/|v2|
|
|
*/
|
|
#define BrVector2Normalise(v1,v2) do {\
|
|
br_scalar _scale;\
|
|
_scale = BR_LENGTH2((v2)->v[0],(v2)->v[1]);\
|
|
if(_scale > (BR_SCALAR_EPSILON*2)) {\
|
|
_scale = BR_RCP(_scale);\
|
|
(v1)->v[0]=BR_MUL((v2)->v[0],_scale);\
|
|
(v1)->v[1]=BR_MUL((v2)->v[1],_scale);\
|
|
} else {\
|
|
(v1)->v[0]=BR_FRACTION(1.0);\
|
|
(v1)->v[1]=BR_FRACTION(0.0);\
|
|
}\
|
|
} while(0)
|
|
|
|
#ifdef __cplusplus
|
|
};
|
|
#endif
|
|
#endif
|
|
|