#include <string>
#include <stdio.h>
#include <cmath>
#include <assert.h>
#include <vector>
#include <stdlib.h>
//#define USE_DOT
//#define USE_SSE
static const float CMP_EPS = 1e-4f;
static const float NORMALIZE_EPS = 1e-12f;
typedef float v4sf __attribute__ ((vector_size (16))); // vector of three single floats
struct f3vector {
union
{
v4sf v;
struct { float x,y,z,w; };
struct { int ix,iy,iz,iw; };
};
};
struct float3 : public f3vector {
float3(const float _x, const float _y, const float _z) {
x = _x; y = _y; z = _z;
}
#ifdef USE_SSE
float3& operator+= (const float3& f) {
v += f.v;
return *this;
}
#else
float3& operator+= (const float3& f) {
x += f.x; y += f.y; z += f.z;
return *this;
}
#endif
inline float SqDistance(const float3& f) const {
const float dx = x - f.x;
const float dy = y - f.y;
const float dz = z - f.z;
return (dx*dx + dy*dy + dz*dz);
}
#ifdef USE_DOT
bool equals(const float3& f) const {
return this->SqDistance(f) <= CMP_EPS;
}
#elif defined(USE_SSE)
bool equals(float3& f) {
f3vector n;
n.v = (v - f.v);
n.v *= n.v;
return (n.x + n.y + n.z) <= CMP_EPS;
}
#else
bool equals(const float3& f) const {
return std::fabs(x - f.x) <= CMP_EPS
&& std::fabs(y - f.y) <= CMP_EPS
&& std::fabs(z - f.z) <= CMP_EPS;
}
#endif
};
int main() {
float3 a(0.1f,0.1f,0.1f);
float3 b(100.1f,100.2f,100.3f);
float3 c(0.1f,0.2f,0.3f);
float3 d((float)rand()/(float)RAND_MAX, (float)rand()/(float)RAND_MAX, (float)rand()/(float)RAND_MAX);
for (int i = 1<<27; i>0; --i) {
if (a.equals(b)) {
b += d;
a = b;
}
a += d;
}
/*for (int i = 1<<27; i>0; --i) {
if (a.equals(b)) {
b += a;
a += c;
}
a += c;
}*/
printf("%f %f %f\n", a.x, a.y, a.z);
return 0;
}
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