Renamed AABB::pos --> AABB::position
parent
7dde412e26
commit
b9ba10a717
|
@ -11,7 +11,7 @@ namespace godot {
|
||||||
|
|
||||||
class AABB {
|
class AABB {
|
||||||
public:
|
public:
|
||||||
Vector3 pos;
|
Vector3 position;
|
||||||
Vector3 size;
|
Vector3 size;
|
||||||
|
|
||||||
real_t get_area() const; /// get area
|
real_t get_area() const; /// get area
|
||||||
|
@ -25,8 +25,8 @@ public:
|
||||||
return (size.x<=CMP_EPSILON && size.y<=CMP_EPSILON && size.z<=CMP_EPSILON);
|
return (size.x<=CMP_EPSILON && size.y<=CMP_EPSILON && size.z<=CMP_EPSILON);
|
||||||
}
|
}
|
||||||
|
|
||||||
inline const Vector3& get_pos() const { return pos; }
|
inline const Vector3& get_position() const { return position; }
|
||||||
inline void set_pos(const Vector3& p_pos) { pos=p_pos; }
|
inline void set_position(const Vector3& p_position) { position=p_position; }
|
||||||
inline const Vector3& get_size() const { return size; }
|
inline const Vector3& get_size() const { return size; }
|
||||||
inline void set_size(const Vector3& p_size) { size=p_size; }
|
inline void set_size(const Vector3& p_size) { size=p_size; }
|
||||||
|
|
||||||
|
@ -73,7 +73,7 @@ public:
|
||||||
operator String() const;
|
operator String() const;
|
||||||
|
|
||||||
inline AABB() {}
|
inline AABB() {}
|
||||||
inline AABB(const Vector3 &p_pos,const Vector3& p_size) { pos=p_pos; size=p_size; }
|
inline AABB(const Vector3 &p_pos,const Vector3& p_size) { position=p_pos; size=p_size; }
|
||||||
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
|
@ -8,17 +8,17 @@ namespace godot {
|
||||||
|
|
||||||
bool AABB::intersects(const AABB& p_aabb) const {
|
bool AABB::intersects(const AABB& p_aabb) const {
|
||||||
|
|
||||||
if ( pos.x >= (p_aabb.pos.x + p_aabb.size.x) )
|
if ( position.x >= (p_aabb.position.x + p_aabb.size.x) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.x+size.x) <= p_aabb.pos.x )
|
if ( (position.x+size.x) <= p_aabb.position.x )
|
||||||
return false;
|
return false;
|
||||||
if ( pos.y >= (p_aabb.pos.y + p_aabb.size.y) )
|
if ( position.y >= (p_aabb.position.y + p_aabb.size.y) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.y+size.y) <= p_aabb.pos.y )
|
if ( (position.y+size.y) <= p_aabb.position.y )
|
||||||
return false;
|
return false;
|
||||||
if ( pos.z >= (p_aabb.pos.z + p_aabb.size.z) )
|
if ( position.z >= (p_aabb.position.z + p_aabb.size.z) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.z+size.z) <= p_aabb.pos.z )
|
if ( (position.z+size.z) <= p_aabb.position.z )
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
|
@ -26,17 +26,17 @@ bool AABB::intersects(const AABB& p_aabb) const {
|
||||||
|
|
||||||
bool AABB::intersects_inclusive(const AABB& p_aabb) const {
|
bool AABB::intersects_inclusive(const AABB& p_aabb) const {
|
||||||
|
|
||||||
if ( pos.x > (p_aabb.pos.x + p_aabb.size.x) )
|
if ( position.x > (p_aabb.position.x + p_aabb.size.x) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.x+size.x) < p_aabb.pos.x )
|
if ( (position.x+size.x) < p_aabb.position.x )
|
||||||
return false;
|
return false;
|
||||||
if ( pos.y > (p_aabb.pos.y + p_aabb.size.y) )
|
if ( position.y > (p_aabb.position.y + p_aabb.size.y) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.y+size.y) < p_aabb.pos.y )
|
if ( (position.y+size.y) < p_aabb.position.y )
|
||||||
return false;
|
return false;
|
||||||
if ( pos.z > (p_aabb.pos.z + p_aabb.size.z) )
|
if ( position.z > (p_aabb.position.z + p_aabb.size.z) )
|
||||||
return false;
|
return false;
|
||||||
if ( (pos.z+size.z) < p_aabb.pos.z )
|
if ( (position.z+size.z) < p_aabb.position.z )
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
|
@ -44,10 +44,10 @@ bool AABB::intersects_inclusive(const AABB& p_aabb) const {
|
||||||
|
|
||||||
bool AABB::encloses(const AABB & p_aabb) const {
|
bool AABB::encloses(const AABB & p_aabb) const {
|
||||||
|
|
||||||
Vector3 src_min=pos;
|
Vector3 src_min=position;
|
||||||
Vector3 src_max=pos+size;
|
Vector3 src_max=position+size;
|
||||||
Vector3 dst_min=p_aabb.pos;
|
Vector3 dst_min=p_aabb.position;
|
||||||
Vector3 dst_max=p_aabb.pos+p_aabb.size;
|
Vector3 dst_max=p_aabb.position+p_aabb.size;
|
||||||
|
|
||||||
return (
|
return (
|
||||||
(src_min.x <= dst_min.x) &&
|
(src_min.x <= dst_min.x) &&
|
||||||
|
@ -62,7 +62,7 @@ bool AABB::encloses(const AABB & p_aabb) const {
|
||||||
Vector3 AABB::get_support(const Vector3& p_normal) const {
|
Vector3 AABB::get_support(const Vector3& p_normal) const {
|
||||||
|
|
||||||
Vector3 half_extents = size * 0.5;
|
Vector3 half_extents = size * 0.5;
|
||||||
Vector3 ofs = pos + half_extents;
|
Vector3 ofs = position + half_extents;
|
||||||
|
|
||||||
return Vector3(
|
return Vector3(
|
||||||
(p_normal.x>0) ? -half_extents.x : half_extents.x,
|
(p_normal.x>0) ? -half_extents.x : half_extents.x,
|
||||||
|
@ -75,14 +75,14 @@ Vector3 AABB::get_support(const Vector3& p_normal) const {
|
||||||
Vector3 AABB::get_endpoint(int p_point) const {
|
Vector3 AABB::get_endpoint(int p_point) const {
|
||||||
|
|
||||||
switch(p_point) {
|
switch(p_point) {
|
||||||
case 0: return Vector3( pos.x , pos.y , pos.z );
|
case 0: return Vector3( position.x , position.y , position.z );
|
||||||
case 1: return Vector3( pos.x , pos.y , pos.z+size.z );
|
case 1: return Vector3( position.x , position.y , position.z+size.z );
|
||||||
case 2: return Vector3( pos.x , pos.y+size.y , pos.z );
|
case 2: return Vector3( position.x , position.y+size.y , position.z );
|
||||||
case 3: return Vector3( pos.x , pos.y+size.y , pos.z+size.z );
|
case 3: return Vector3( position.x , position.y+size.y , position.z+size.z );
|
||||||
case 4: return Vector3( pos.x+size.x , pos.y , pos.z );
|
case 4: return Vector3( position.x+size.x , position.y , position.z );
|
||||||
case 5: return Vector3( pos.x+size.x , pos.y , pos.z+size.z );
|
case 5: return Vector3( position.x+size.x , position.y , position.z+size.z );
|
||||||
case 6: return Vector3( pos.x+size.x , pos.y+size.y , pos.z );
|
case 6: return Vector3( position.x+size.x , position.y+size.y , position.z );
|
||||||
case 7: return Vector3( pos.x+size.x , pos.y+size.y , pos.z+size.z );
|
case 7: return Vector3( position.x+size.x , position.y+size.y , position.z+size.z );
|
||||||
};
|
};
|
||||||
|
|
||||||
ERR_FAIL_V(Vector3());
|
ERR_FAIL_V(Vector3());
|
||||||
|
@ -91,7 +91,7 @@ Vector3 AABB::get_endpoint(int p_point) const {
|
||||||
bool AABB::intersects_convex_shape(const Plane *p_planes, int p_plane_count) const {
|
bool AABB::intersects_convex_shape(const Plane *p_planes, int p_plane_count) const {
|
||||||
|
|
||||||
Vector3 half_extents = size * 0.5;
|
Vector3 half_extents = size * 0.5;
|
||||||
Vector3 ofs = pos + half_extents;
|
Vector3 ofs = position + half_extents;
|
||||||
|
|
||||||
for(int i=0;i<p_plane_count;i++) {
|
for(int i=0;i<p_plane_count;i++) {
|
||||||
const Plane &p=p_planes[i];
|
const Plane &p=p_planes[i];
|
||||||
|
@ -110,17 +110,17 @@ bool AABB::intersects_convex_shape(const Plane *p_planes, int p_plane_count) con
|
||||||
|
|
||||||
bool AABB::has_point(const Vector3& p_point) const {
|
bool AABB::has_point(const Vector3& p_point) const {
|
||||||
|
|
||||||
if (p_point.x<pos.x)
|
if (p_point.x<position.x)
|
||||||
return false;
|
return false;
|
||||||
if (p_point.y<pos.y)
|
if (p_point.y<position.y)
|
||||||
return false;
|
return false;
|
||||||
if (p_point.z<pos.z)
|
if (p_point.z<position.z)
|
||||||
return false;
|
return false;
|
||||||
if (p_point.x>pos.x+size.x)
|
if (p_point.x>position.x+size.x)
|
||||||
return false;
|
return false;
|
||||||
if (p_point.y>pos.y+size.y)
|
if (p_point.y>position.y+size.y)
|
||||||
return false;
|
return false;
|
||||||
if (p_point.z>pos.z+size.z)
|
if (p_point.z>position.z+size.z)
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
|
@ -129,8 +129,8 @@ bool AABB::has_point(const Vector3& p_point) const {
|
||||||
|
|
||||||
void AABB::expand_to(const Vector3& p_vector) {
|
void AABB::expand_to(const Vector3& p_vector) {
|
||||||
|
|
||||||
Vector3 begin=pos;
|
Vector3 begin=position;
|
||||||
Vector3 end=pos+size;
|
Vector3 end=position+size;
|
||||||
|
|
||||||
if (p_vector.x<begin.x)
|
if (p_vector.x<begin.x)
|
||||||
begin.x=p_vector.x;
|
begin.x=p_vector.x;
|
||||||
|
@ -146,14 +146,14 @@ void AABB::expand_to(const Vector3& p_vector) {
|
||||||
if (p_vector.z>end.z)
|
if (p_vector.z>end.z)
|
||||||
end.z=p_vector.z;
|
end.z=p_vector.z;
|
||||||
|
|
||||||
pos=begin;
|
position=begin;
|
||||||
size=end-begin;
|
size=end-begin;
|
||||||
}
|
}
|
||||||
|
|
||||||
void AABB::project_range_in_plane(const Plane& p_plane,real_t &r_min,real_t& r_max) const {
|
void AABB::project_range_in_plane(const Plane& p_plane,real_t &r_min,real_t& r_max) const {
|
||||||
|
|
||||||
Vector3 half_extents( size.x * 0.5, size.y * 0.5, size.z * 0.5 );
|
Vector3 half_extents( size.x * 0.5, size.y * 0.5, size.z * 0.5 );
|
||||||
Vector3 center( pos.x + half_extents.x, pos.y + half_extents.y, pos.z + half_extents.z );
|
Vector3 center( position.x + half_extents.x, position.y + half_extents.y, position.z + half_extents.z );
|
||||||
|
|
||||||
real_t length = p_plane.normal.abs().dot(half_extents);
|
real_t length = p_plane.normal.abs().dot(half_extents);
|
||||||
real_t distance = p_plane.distance_to( center );
|
real_t distance = p_plane.distance_to( center );
|
||||||
|
@ -197,23 +197,23 @@ bool AABB::smits_intersect_ray(const Vector3 &from,const Vector3& dir, real_t t0
|
||||||
real_t divy=1.0/dir.y;
|
real_t divy=1.0/dir.y;
|
||||||
real_t divz=1.0/dir.z;
|
real_t divz=1.0/dir.z;
|
||||||
|
|
||||||
Vector3 upbound=pos+size;
|
Vector3 upbound=position+size;
|
||||||
real_t tmin, tmax, tymin, tymax, tzmin, tzmax;
|
real_t tmin, tmax, tymin, tymax, tzmin, tzmax;
|
||||||
if (dir.x >= 0) {
|
if (dir.x >= 0) {
|
||||||
tmin = (pos.x - from.x) * divx;
|
tmin = (position.x - from.x) * divx;
|
||||||
tmax = (upbound.x - from.x) * divx;
|
tmax = (upbound.x - from.x) * divx;
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
tmin = (upbound.x - from.x) * divx;
|
tmin = (upbound.x - from.x) * divx;
|
||||||
tmax = (pos.x - from.x) * divx;
|
tmax = (position.x - from.x) * divx;
|
||||||
}
|
}
|
||||||
if (dir.y >= 0) {
|
if (dir.y >= 0) {
|
||||||
tymin = (pos.y - from.y) * divy;
|
tymin = (position.y - from.y) * divy;
|
||||||
tymax = (upbound.y - from.y) * divy;
|
tymax = (upbound.y - from.y) * divy;
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
tymin = (upbound.y - from.y) * divy;
|
tymin = (upbound.y - from.y) * divy;
|
||||||
tymax = (pos.y - from.y) * divy;
|
tymax = (position.y - from.y) * divy;
|
||||||
}
|
}
|
||||||
if ( (tmin > tymax) || (tymin > tmax) )
|
if ( (tmin > tymax) || (tymin > tmax) )
|
||||||
return false;
|
return false;
|
||||||
|
@ -222,12 +222,12 @@ bool AABB::smits_intersect_ray(const Vector3 &from,const Vector3& dir, real_t t0
|
||||||
if (tymax < tmax)
|
if (tymax < tmax)
|
||||||
tmax = tymax;
|
tmax = tymax;
|
||||||
if (dir.z >= 0) {
|
if (dir.z >= 0) {
|
||||||
tzmin = (pos.z - from.z) * divz;
|
tzmin = (position.z - from.z) * divz;
|
||||||
tzmax = (upbound.z - from.z) * divz;
|
tzmax = (upbound.z - from.z) * divz;
|
||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
tzmin = (upbound.z - from.z) * divz;
|
tzmin = (upbound.z - from.z) * divz;
|
||||||
tzmax = (pos.z - from.z) * divz;
|
tzmax = (position.z - from.z) * divz;
|
||||||
}
|
}
|
||||||
if ( (tmin > tzmax) || (tzmin > tmax) )
|
if ( (tmin > tzmax) || (tzmin > tmax) )
|
||||||
return false;
|
return false;
|
||||||
|
@ -240,9 +240,9 @@ bool AABB::smits_intersect_ray(const Vector3 &from,const Vector3& dir, real_t t0
|
||||||
|
|
||||||
void AABB::grow_by(real_t p_amount) {
|
void AABB::grow_by(real_t p_amount) {
|
||||||
|
|
||||||
pos.x-=p_amount;
|
position.x-=p_amount;
|
||||||
pos.y-=p_amount;
|
position.y-=p_amount;
|
||||||
pos.z-=p_amount;
|
position.z-=p_amount;
|
||||||
size.x+=2.0*p_amount;
|
size.x+=2.0*p_amount;
|
||||||
size.y+=2.0*p_amount;
|
size.y+=2.0*p_amount;
|
||||||
size.z+=2.0*p_amount;
|
size.z+=2.0*p_amount;
|
||||||
|
@ -257,12 +257,12 @@ real_t AABB::get_area() const {
|
||||||
|
|
||||||
bool AABB::operator==(const AABB& p_rval) const {
|
bool AABB::operator==(const AABB& p_rval) const {
|
||||||
|
|
||||||
return ((pos==p_rval.pos) && (size==p_rval.size));
|
return ((position==p_rval.position) && (size==p_rval.size));
|
||||||
|
|
||||||
}
|
}
|
||||||
bool AABB::operator!=(const AABB& p_rval) const {
|
bool AABB::operator!=(const AABB& p_rval) const {
|
||||||
|
|
||||||
return ((pos!=p_rval.pos) || (size!=p_rval.size));
|
return ((position!=p_rval.position) || (size!=p_rval.size));
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -272,8 +272,8 @@ void AABB::merge_with(const AABB& p_aabb) {
|
||||||
Vector3 end_1,end_2;
|
Vector3 end_1,end_2;
|
||||||
Vector3 min,max;
|
Vector3 min,max;
|
||||||
|
|
||||||
beg_1=pos;
|
beg_1=position;
|
||||||
beg_2=p_aabb.pos;
|
beg_2=p_aabb.position;
|
||||||
end_1=Vector3(size.x,size.y,size.z)+beg_1;
|
end_1=Vector3(size.x,size.y,size.z)+beg_1;
|
||||||
end_2=Vector3(p_aabb.size.x,p_aabb.size.y,p_aabb.size.z)+beg_2;
|
end_2=Vector3(p_aabb.size.x,p_aabb.size.y,p_aabb.size.z)+beg_2;
|
||||||
|
|
||||||
|
@ -285,16 +285,16 @@ void AABB::merge_with(const AABB& p_aabb) {
|
||||||
max.y=(end_1.y>end_2.y)?end_1.y:end_2.y;
|
max.y=(end_1.y>end_2.y)?end_1.y:end_2.y;
|
||||||
max.z=(end_1.z>end_2.z)?end_1.z:end_2.z;
|
max.z=(end_1.z>end_2.z)?end_1.z:end_2.z;
|
||||||
|
|
||||||
pos=min;
|
position=min;
|
||||||
size=max-min;
|
size=max-min;
|
||||||
}
|
}
|
||||||
|
|
||||||
AABB AABB::intersection(const AABB& p_aabb) const {
|
AABB AABB::intersection(const AABB& p_aabb) const {
|
||||||
|
|
||||||
Vector3 src_min=pos;
|
Vector3 src_min=position;
|
||||||
Vector3 src_max=pos+size;
|
Vector3 src_max=position+size;
|
||||||
Vector3 dst_min=p_aabb.pos;
|
Vector3 dst_min=p_aabb.position;
|
||||||
Vector3 dst_max=p_aabb.pos+p_aabb.size;
|
Vector3 dst_max=p_aabb.position+p_aabb.size;
|
||||||
|
|
||||||
Vector3 min,max;
|
Vector3 min,max;
|
||||||
|
|
||||||
|
@ -332,18 +332,18 @@ AABB AABB::intersection(const AABB& p_aabb) const {
|
||||||
bool AABB::intersects_ray(const Vector3& p_from, const Vector3& p_dir,Vector3* r_clip,Vector3* r_normal) const {
|
bool AABB::intersects_ray(const Vector3& p_from, const Vector3& p_dir,Vector3* r_clip,Vector3* r_normal) const {
|
||||||
|
|
||||||
Vector3 c1, c2;
|
Vector3 c1, c2;
|
||||||
Vector3 end = pos+size;
|
Vector3 end = position+size;
|
||||||
real_t near=-1e20;
|
real_t near=-1e20;
|
||||||
real_t far=1e20;
|
real_t far=1e20;
|
||||||
int axis=0;
|
int axis=0;
|
||||||
|
|
||||||
for (int i=0;i<3;i++){
|
for (int i=0;i<3;i++){
|
||||||
if (p_dir[i] == 0){
|
if (p_dir[i] == 0){
|
||||||
if ((p_from[i] < pos[i]) || (p_from[i] > end[i])) {
|
if ((p_from[i] < position[i]) || (p_from[i] > end[i])) {
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
} else { // ray not parallel to planes in this direction
|
} else { // ray not parallel to planes in this direction
|
||||||
c1[i] = (pos[i] - p_from[i]) / p_dir[i];
|
c1[i] = (position[i] - p_from[i]) / p_dir[i];
|
||||||
c2[i] = (end[i] - p_from[i]) / p_dir[i];
|
c2[i] = (end[i] - p_from[i]) / p_dir[i];
|
||||||
|
|
||||||
if(c1[i] > c2[i]){
|
if(c1[i] > c2[i]){
|
||||||
|
@ -383,7 +383,7 @@ bool AABB::intersects_segment(const Vector3& p_from, const Vector3& p_to,Vector3
|
||||||
for(int i=0;i<3;i++) {
|
for(int i=0;i<3;i++) {
|
||||||
real_t seg_from=p_from[i];
|
real_t seg_from=p_from[i];
|
||||||
real_t seg_to=p_to[i];
|
real_t seg_to=p_to[i];
|
||||||
real_t box_begin=pos[i];
|
real_t box_begin=position[i];
|
||||||
real_t box_end=box_begin+size[i];
|
real_t box_end=box_begin+size[i];
|
||||||
real_t cmin,cmax;
|
real_t cmin,cmax;
|
||||||
real_t csign;
|
real_t csign;
|
||||||
|
@ -438,14 +438,14 @@ bool AABB::intersects_segment(const Vector3& p_from, const Vector3& p_to,Vector3
|
||||||
bool AABB::intersects_plane(const Plane &p_plane) const {
|
bool AABB::intersects_plane(const Plane &p_plane) const {
|
||||||
|
|
||||||
Vector3 points[8] = {
|
Vector3 points[8] = {
|
||||||
Vector3( pos.x , pos.y , pos.z ),
|
Vector3( position.x , position.y , position.z ),
|
||||||
Vector3( pos.x , pos.y , pos.z+size.z ),
|
Vector3( position.x , position.y , position.z+size.z ),
|
||||||
Vector3( pos.x , pos.y+size.y , pos.z ),
|
Vector3( position.x , position.y+size.y , position.z ),
|
||||||
Vector3( pos.x , pos.y+size.y , pos.z+size.z ),
|
Vector3( position.x , position.y+size.y , position.z+size.z ),
|
||||||
Vector3( pos.x+size.x , pos.y , pos.z ),
|
Vector3( position.x+size.x , position.y , position.z ),
|
||||||
Vector3( pos.x+size.x , pos.y , pos.z+size.z ),
|
Vector3( position.x+size.x , position.y , position.z+size.z ),
|
||||||
Vector3( pos.x+size.x , pos.y+size.y , pos.z ),
|
Vector3( position.x+size.x , position.y+size.y , position.z ),
|
||||||
Vector3( pos.x+size.x , pos.y+size.y , pos.z+size.z ),
|
Vector3( position.x+size.x , position.y+size.y , position.z+size.z ),
|
||||||
};
|
};
|
||||||
|
|
||||||
bool over=false;
|
bool over=false;
|
||||||
|
@ -562,68 +562,68 @@ void AABB::get_edge(int p_edge,Vector3& r_from,Vector3& r_to) const {
|
||||||
|
|
||||||
case 0:{
|
case 0:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x+size.x , pos.y , pos.z );
|
r_from=Vector3( position.x+size.x , position.y , position.z );
|
||||||
r_to=Vector3( pos.x , pos.y , pos.z );
|
r_to=Vector3( position.x , position.y , position.z );
|
||||||
} break;
|
} break;
|
||||||
case 1:{
|
case 1:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x+size.x , pos.y , pos.z+size.z );
|
r_from=Vector3( position.x+size.x , position.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y , pos.z );
|
r_to=Vector3( position.x+size.x , position.y , position.z );
|
||||||
} break;
|
} break;
|
||||||
case 2:{
|
case 2:{
|
||||||
r_from=Vector3( pos.x , pos.y , pos.z+size.z );
|
r_from=Vector3( position.x , position.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y , pos.z+size.z );
|
r_to=Vector3( position.x+size.x , position.y , position.z+size.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 3:{
|
case 3:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x , pos.y , pos.z );
|
r_from=Vector3( position.x , position.y , position.z );
|
||||||
r_to=Vector3( pos.x , pos.y , pos.z+size.z );
|
r_to=Vector3( position.x , position.y , position.z+size.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 4:{
|
case 4:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x , pos.y+size.y , pos.z );
|
r_from=Vector3( position.x , position.y+size.y , position.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y+size.y , pos.z );
|
r_to=Vector3( position.x+size.x , position.y+size.y , position.z );
|
||||||
} break;
|
} break;
|
||||||
case 5:{
|
case 5:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x+size.x , pos.y+size.y , pos.z );
|
r_from=Vector3( position.x+size.x , position.y+size.y , position.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y+size.y , pos.z+size.z );
|
r_to=Vector3( position.x+size.x , position.y+size.y , position.z+size.z );
|
||||||
} break;
|
} break;
|
||||||
case 6:{
|
case 6:{
|
||||||
r_from=Vector3( pos.x+size.x , pos.y+size.y , pos.z+size.z );
|
r_from=Vector3( position.x+size.x , position.y+size.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x , pos.y+size.y , pos.z+size.z );
|
r_to=Vector3( position.x , position.y+size.y , position.z+size.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 7:{
|
case 7:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x , pos.y+size.y , pos.z+size.z );
|
r_from=Vector3( position.x , position.y+size.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x , pos.y+size.y , pos.z );
|
r_to=Vector3( position.x , position.y+size.y , position.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 8:{
|
case 8:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x , pos.y , pos.z+size.z );
|
r_from=Vector3( position.x , position.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x , pos.y+size.y , pos.z+size.z );
|
r_to=Vector3( position.x , position.y+size.y , position.z+size.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 9:{
|
case 9:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x , pos.y , pos.z );
|
r_from=Vector3( position.x , position.y , position.z );
|
||||||
r_to=Vector3( pos.x , pos.y+size.y , pos.z );
|
r_to=Vector3( position.x , position.y+size.y , position.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 10:{
|
case 10:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x+size.x , pos.y , pos.z );
|
r_from=Vector3( position.x+size.x , position.y , position.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y+size.y , pos.z );
|
r_to=Vector3( position.x+size.x , position.y+size.y , position.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
case 11:{
|
case 11:{
|
||||||
|
|
||||||
r_from=Vector3( pos.x+size.x , pos.y , pos.z+size.z );
|
r_from=Vector3( position.x+size.x , position.y , position.z+size.z );
|
||||||
r_to=Vector3( pos.x+size.x , pos.y+size.y , pos.z+size.z );
|
r_to=Vector3( position.x+size.x , position.y+size.y , position.z+size.z );
|
||||||
|
|
||||||
} break;
|
} break;
|
||||||
|
|
||||||
|
@ -633,7 +633,7 @@ void AABB::get_edge(int p_edge,Vector3& r_from,Vector3& r_to) const {
|
||||||
|
|
||||||
AABB::operator String() const {
|
AABB::operator String() const {
|
||||||
|
|
||||||
//return String()+pos +" - "+ size;
|
//return String()+position +" - "+ size;
|
||||||
return String(); // @Todo
|
return String(); // @Todo
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -90,10 +90,10 @@ AABB Transform::xform(const AABB& p_aabb) const {
|
||||||
Vector3 x=basis.get_axis(0)*p_aabb.size.x;
|
Vector3 x=basis.get_axis(0)*p_aabb.size.x;
|
||||||
Vector3 y=basis.get_axis(1)*p_aabb.size.y;
|
Vector3 y=basis.get_axis(1)*p_aabb.size.y;
|
||||||
Vector3 z=basis.get_axis(2)*p_aabb.size.z;
|
Vector3 z=basis.get_axis(2)*p_aabb.size.z;
|
||||||
Vector3 pos = xform( p_aabb.pos );
|
Vector3 pos = xform( p_aabb.position );
|
||||||
//could be even further optimized
|
//could be even further optimized
|
||||||
AABB new_aabb;
|
AABB new_aabb;
|
||||||
new_aabb.pos=pos;
|
new_aabb.position=pos;
|
||||||
new_aabb.expand_to( pos+x );
|
new_aabb.expand_to( pos+x );
|
||||||
new_aabb.expand_to( pos+y );
|
new_aabb.expand_to( pos+y );
|
||||||
new_aabb.expand_to( pos+z );
|
new_aabb.expand_to( pos+z );
|
||||||
|
@ -108,20 +108,20 @@ AABB Transform::xform_inv(const AABB& p_aabb) const {
|
||||||
|
|
||||||
/* define vertices */
|
/* define vertices */
|
||||||
Vector3 vertices[8]={
|
Vector3 vertices[8]={
|
||||||
Vector3(p_aabb.pos.x+p_aabb.size.x, p_aabb.pos.y+p_aabb.size.y, p_aabb.pos.z+p_aabb.size.z),
|
Vector3(p_aabb.position.x+p_aabb.size.x, p_aabb.position.y+p_aabb.size.y, p_aabb.position.z+p_aabb.size.z),
|
||||||
Vector3(p_aabb.pos.x+p_aabb.size.x, p_aabb.pos.y+p_aabb.size.y, p_aabb.pos.z),
|
Vector3(p_aabb.position.x+p_aabb.size.x, p_aabb.position.y+p_aabb.size.y, p_aabb.position.z),
|
||||||
Vector3(p_aabb.pos.x+p_aabb.size.x, p_aabb.pos.y, p_aabb.pos.z+p_aabb.size.z),
|
Vector3(p_aabb.position.x+p_aabb.size.x, p_aabb.position.y, p_aabb.position.z+p_aabb.size.z),
|
||||||
Vector3(p_aabb.pos.x+p_aabb.size.x, p_aabb.pos.y, p_aabb.pos.z),
|
Vector3(p_aabb.position.x+p_aabb.size.x, p_aabb.position.y, p_aabb.position.z),
|
||||||
Vector3(p_aabb.pos.x, p_aabb.pos.y+p_aabb.size.y, p_aabb.pos.z+p_aabb.size.z),
|
Vector3(p_aabb.position.x, p_aabb.position.y+p_aabb.size.y, p_aabb.position.z+p_aabb.size.z),
|
||||||
Vector3(p_aabb.pos.x, p_aabb.pos.y+p_aabb.size.y, p_aabb.pos.z),
|
Vector3(p_aabb.position.x, p_aabb.position.y+p_aabb.size.y, p_aabb.position.z),
|
||||||
Vector3(p_aabb.pos.x, p_aabb.pos.y, p_aabb.pos.z+p_aabb.size.z),
|
Vector3(p_aabb.position.x, p_aabb.position.y, p_aabb.position.z+p_aabb.size.z),
|
||||||
Vector3(p_aabb.pos.x, p_aabb.pos.y, p_aabb.pos.z)
|
Vector3(p_aabb.position.x, p_aabb.position.y, p_aabb.position.z)
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
AABB ret;
|
AABB ret;
|
||||||
|
|
||||||
ret.pos=xform_inv(vertices[0]);
|
ret.position=xform_inv(vertices[0]);
|
||||||
|
|
||||||
for (int i=1;i<8;i++) {
|
for (int i=1;i<8;i++) {
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue