00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023 #ifndef _ODE_COMMON_H_
00024 #define _ODE_COMMON_H_
00025 #include <ode/config.h>
00026 #include <ode/error.h>
00027 #include <math.h>
00028
00029 #ifdef __cplusplus
00030 extern "C" {
00031 #endif
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041
00042
00043
00044
00045 #define EFFICIENT_ALIGNMENT 16
00046
00047
00048
00049
00050
00051
00052
00053
00054 #ifndef M_PI
00055 #define M_PI REAL(3.1415926535897932384626433832795029)
00056 #endif
00057 #ifndef M_SQRT1_2
00058 #define M_SQRT1_2 REAL(0.7071067811865475244008443621048490)
00059 #endif
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072 #ifndef dNODEBUG
00073 #ifdef __GNUC__
00074 #define dIASSERT(a) if (!(a)) dDebug (d_ERR_IASSERT, \
00075 "assertion \"" #a "\" failed in %s() [%s]",__FUNCTION__,__FILE__);
00076 #define dUASSERT(a,msg) if (!(a)) dDebug (d_ERR_UASSERT, \
00077 msg " in %s()", __FUNCTION__);
00078 #define dDEBUGMSG(msg) dMessage (d_ERR_UASSERT, \
00079 msg " in %s() File %s Line %d", __FUNCTION__, __FILE__,__LINE__);
00080 #else
00081 #define dIASSERT(a) if (!(a)) dDebug (d_ERR_IASSERT, \
00082 "assertion \"" #a "\" failed in %s:%d",__FILE__,__LINE__);
00083 #define dUASSERT(a,msg) if (!(a)) dDebug (d_ERR_UASSERT, \
00084 msg " (%s:%d)", __FILE__,__LINE__);
00085 #define dDEBUGMSG(msg) dMessage (d_ERR_UASSERT, \
00086 msg " (%s:%d)", __FILE__,__LINE__);
00087 #endif
00088 #else
00089 #define dIASSERT(a) ;
00090 #define dUASSERT(a,msg) ;
00091 #define dDEBUGMSG(msg) ;
00092 #endif
00093 #define dAASSERT(a) dUASSERT(a,"Bad argument(s)")
00094
00095
00096
00097 #if defined(dSINGLE)
00098 typedef float dReal;
00099 #ifdef dDOUBLE
00100 #error You can only #define dSINGLE or dDOUBLE, not both.
00101 #endif // dDOUBLE
00102 #elif defined(dDOUBLE)
00103 typedef double dReal;
00104 #else
00105 #error You must #define dSINGLE or dDOUBLE
00106 #endif
00107
00108
00109 #if dTRIMESH_ENABLED
00110 #if dTRIMESH_OPCODE && dTRIMESH_GIMPACT
00111 #error You can only #define dTRIMESH_OPCODE or dTRIMESH_GIMPACT, not both.
00112 #endif
00113 #endif // dTRIMESH_ENABLED
00114
00115
00116
00117
00118 #define dPAD(a) (((a) > 1) ? ((((a)-1)|3)+1) : (a))
00119
00120
00121 typedef dReal dVector3[4];
00122 typedef dReal dVector4[4];
00123 typedef dReal dMatrix3[4*3];
00124 typedef dReal dMatrix4[4*4];
00125 typedef dReal dMatrix6[8*6];
00126 typedef dReal dQuaternion[4];
00127
00128
00129
00130
00131 #if defined(dSINGLE)
00132
00133 #define REAL(x) (x ## f)
00134 #define dRecip(x) ((1.0f/(x)))
00135 #define dSqrt(x) (sqrtf(x))
00136 #define dRecipSqrt(x) ((1.0f/sqrtf(x)))
00137 #define dSin(x) (sinf(x))
00138 #define dCos(x) (cosf(x))
00139 #define dFabs(x) (fabsf(x))
00140 #define dAtan2(y,x) (atan2f(y,x))
00141 #define dFMod(a,b) (fmodf(a,b))
00142 #define dFloor(x) floorf(x)
00143
00144 #ifdef HAVE___ISNANF
00145 #define dIsNan(x) (__isnanf(x))
00146 #elif defined(HAVE__ISNANF)
00147 #define dIsNan(x) (_isnanf(x))
00148 #elif defined(HAVE_ISNANF)
00149 #define dIsNan(x) (isnanf(x))
00150 #else
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160 #define dIsNan(x) (_isnan(x))
00161 #endif
00162
00163 #define dCopySign(a,b) ((dReal)copysignf(a,b))
00164
00165 #elif defined(dDOUBLE)
00166
00167 #define REAL(x) (x)
00168 #define dRecip(x) (1.0/(x))
00169 #define dSqrt(x) sqrt(x)
00170 #define dRecipSqrt(x) (1.0/sqrt(x))
00171 #define dSin(x) sin(x)
00172 #define dCos(x) cos(x)
00173 #define dFabs(x) fabs(x)
00174 #define dAtan2(y,x) atan2((y),(x))
00175 #define dFMod(a,b) (fmod((a),(b)))
00176 #define dFloor(x) floor(x)
00177
00178 #ifdef HAVE___ISNAN
00179 #define dIsNan(x) (__isnan(x))
00180 #elif defined(HAVE__ISNAN)
00181 #define dIsNan(x) (_isnan(x))
00182 #elif defined(HAVE_ISNAN)
00183 #define dIsNan(x) (isnan(x))
00184 #else
00185 #define dIsNan(x) (_isnan(x))
00186 #endif
00187
00188 #define dCopySign(a,b) (copysign((a),(b)))
00189
00190 #else
00191 #error You must #define dSINGLE or dDOUBLE
00192 #endif
00193
00194
00195
00196
00197
00198
00199
00200 #define dEFFICIENT_SIZE(x) ((((x)-1)|(EFFICIENT_ALIGNMENT-1))+1)
00201
00202
00203
00204
00205
00206
00207 #define dALLOCA16(n) \
00208 ((char*)dEFFICIENT_SIZE(((size_t)(alloca((n)+(EFFICIENT_ALIGNMENT-1))))))
00209
00210
00211
00212
00213
00214
00215
00216
00217
00218 #ifdef dUSE_MALLOC_FOR_ALLOCA
00219 enum {
00220 d_MEMORY_OK = 0,
00221 d_MEMORY_OUT_OF_MEMORY
00222 };
00223
00224 #endif
00225
00226
00227
00228
00229
00230 struct dxWorld;
00231 struct dxSpace;
00232 struct dxBody;
00233 struct dxGeom;
00234 struct dxJoint;
00235 struct dxJointNode;
00236 struct dxJointGroup;
00237
00238 typedef struct dxWorld *dWorldID;
00239 typedef struct dxSpace *dSpaceID;
00240 typedef struct dxBody *dBodyID;
00241 typedef struct dxGeom *dGeomID;
00242 typedef struct dxJoint *dJointID;
00243 typedef struct dxJointGroup *dJointGroupID;
00244
00245
00246
00247
00248 enum {
00249 d_ERR_UNKNOWN = 0,
00250 d_ERR_IASSERT,
00251 d_ERR_UASSERT,
00252 d_ERR_LCP
00253 };
00254
00255
00256
00257
00258 enum {
00259 dJointTypeNone = 0,
00260 dJointTypeBall,
00261 dJointTypeHinge,
00262 dJointTypeSlider,
00263 dJointTypeContact,
00264 dJointTypeUniversal,
00265 dJointTypeHinge2,
00266 dJointTypeFixed,
00267 dJointTypeNull,
00268 dJointTypeAMotor,
00269 dJointTypeLMotor,
00270 dJointTypePlane2D,
00271 dJointTypePR
00272 };
00273
00274
00275
00276
00277
00278
00279
00280
00281
00282
00283
00284
00285
00286
00287
00288
00289
00290
00291
00292
00293
00294
00295
00296
00297
00298
00299
00300
00301
00302
00303
00304
00305
00306
00307
00308 #define D_ALL_PARAM_NAMES(start) \
00309 \
00310 dParamLoStop = start, \
00311 dParamHiStop, \
00312 dParamVel, \
00313 dParamFMax, \
00314 dParamFudgeFactor, \
00315 dParamBounce, \
00316 dParamCFM, \
00317 dParamStopERP, \
00318 dParamStopCFM, \
00319 \
00320 dParamSuspensionERP, \
00321 dParamSuspensionCFM, \
00322 dParamERP, \
00323
00324 #define D_ALL_PARAM_NAMES_X(start,x) \
00325 \
00326 dParamLoStop ## x = start, \
00327 dParamHiStop ## x, \
00328 dParamVel ## x, \
00329 dParamFMax ## x, \
00330 dParamFudgeFactor ## x, \
00331 dParamBounce ## x, \
00332 dParamCFM ## x, \
00333 dParamStopERP ## x, \
00334 dParamStopCFM ## x, \
00335 \
00336 dParamSuspensionERP ## x, \
00337 dParamSuspensionCFM ## x, \
00338 dParamERP ## x,
00339
00340 enum {
00341 D_ALL_PARAM_NAMES(0)
00342 D_ALL_PARAM_NAMES_X(0x100,2)
00343 D_ALL_PARAM_NAMES_X(0x200,3)
00344
00345
00346
00347
00348 dParamGroup=0x100
00349 };
00350
00351
00352
00353
00354 enum{
00355 dAMotorUser = 0,
00356 dAMotorEuler = 1
00357 };
00358
00359
00360
00361
00362 typedef struct dJointFeedback {
00363 dVector3 f1;
00364 dVector3 t1;
00365 dVector3 f2;
00366 dVector3 t2;
00367 } dJointFeedback;
00368
00369
00370
00371
00372
00373
00374
00375
00376
00377 void dGeomMoved (dGeomID);
00378 dGeomID dGeomGetBodyNext (dGeomID);
00379
00380
00381 #ifdef __cplusplus
00382 }
00383 #endif
00384
00385 #endif