mirror of
https://github.com/burrow-dev/burrow-server.git
synced 2026-11-19 09:37:50 -05:00
376 lines
15 KiB
ActionScript
376 lines
15 KiB
ActionScript
package Box2D.Collision
|
|
{
|
|
import Box2D.Collision.Shapes.*;
|
|
import Box2D.Common.*;
|
|
import Box2D.Common.Math.*;
|
|
|
|
public class b2Distance
|
|
{
|
|
|
|
public static var g_GJK_Iterations:int = 0;
|
|
|
|
private static var s_p1s:Array = [new b2Vec2(),new b2Vec2(),new b2Vec2()];
|
|
|
|
private static var s_p2s:Array = [new b2Vec2(),new b2Vec2(),new b2Vec2()];
|
|
|
|
private static var s_points:Array = [new b2Vec2(),new b2Vec2(),new b2Vec2()];
|
|
|
|
private static var gPoint:b2Point = new b2Point();
|
|
|
|
public function b2Distance()
|
|
{
|
|
super();
|
|
}
|
|
|
|
public static function ProcessTwo(param1:b2Vec2, param2:b2Vec2, param3:Array, param4:Array, param5:Array) : int
|
|
{
|
|
var _loc6_:b2Vec2 = param5[0];
|
|
var _loc7_:b2Vec2 = param5[1];
|
|
var _loc15_:b2Vec2 = param3[0];
|
|
var _loc17_:b2Vec2 = param3[1];
|
|
var _loc16_:b2Vec2 = param4[0];
|
|
var _loc14_:b2Vec2 = param4[1];
|
|
var _loc12_:Number = -_loc7_.x;
|
|
var _loc13_:Number = -_loc7_.y;
|
|
var _loc9_:Number = _loc6_.x - _loc7_.x;
|
|
var _loc8_:Number = _loc6_.y - _loc7_.y;
|
|
var _loc11_:Number = Math.sqrt(_loc9_ * _loc9_ + _loc8_ * _loc8_);
|
|
_loc9_ /= _loc11_;
|
|
_loc8_ /= _loc11_;
|
|
var _loc10_:Number = _loc12_ * _loc9_ + _loc13_ * _loc8_;
|
|
if(_loc10_ <= 0 || _loc11_ < Number.MIN_VALUE)
|
|
{
|
|
param1.SetV(_loc17_);
|
|
param2.SetV(_loc14_);
|
|
_loc15_.SetV(_loc17_);
|
|
_loc16_.SetV(_loc14_);
|
|
_loc6_.SetV(_loc7_);
|
|
return 1;
|
|
}
|
|
_loc10_ /= _loc11_;
|
|
param1.x = _loc17_.x + _loc10_ * (_loc15_.x - _loc17_.x);
|
|
param1.y = _loc17_.y + _loc10_ * (_loc15_.y - _loc17_.y);
|
|
param2.x = _loc14_.x + _loc10_ * (_loc16_.x - _loc14_.x);
|
|
param2.y = _loc14_.y + _loc10_ * (_loc16_.y - _loc14_.y);
|
|
return 2;
|
|
}
|
|
|
|
public static function ProcessThree(param1:b2Vec2, param2:b2Vec2, param3:Array, param4:Array, param5:Array) : int
|
|
{
|
|
var _loc16_:Number = NaN;
|
|
var _loc6_:b2Vec2 = param5[0];
|
|
var _loc8_:b2Vec2 = param5[1];
|
|
var _loc10_:b2Vec2 = param5[2];
|
|
var _loc37_:b2Vec2 = param3[0];
|
|
var _loc39_:b2Vec2 = param3[1];
|
|
var _loc40_:b2Vec2 = param3[2];
|
|
var _loc36_:b2Vec2 = param4[0];
|
|
var _loc35_:b2Vec2 = param4[1];
|
|
var _loc41_:b2Vec2 = param4[2];
|
|
var _loc14_:Number = _loc6_.x;
|
|
var _loc9_:Number = _loc6_.y;
|
|
var _loc29_:Number = _loc8_.x;
|
|
var _loc27_:Number = _loc8_.y;
|
|
var _loc11_:Number = _loc10_.x;
|
|
var _loc13_:Number = _loc10_.y;
|
|
var _loc33_:Number = _loc29_ - _loc14_;
|
|
var _loc38_:Number = _loc27_ - _loc9_;
|
|
var _loc19_:Number = _loc11_ - _loc14_;
|
|
var _loc18_:Number = _loc13_ - _loc9_;
|
|
var _loc21_:Number = _loc11_ - _loc29_;
|
|
var _loc17_:Number = _loc13_ - _loc27_;
|
|
var _loc24_:Number = -(_loc14_ * _loc33_ + _loc9_ * _loc38_);
|
|
var _loc26_:Number = _loc29_ * _loc33_ + _loc27_ * _loc38_;
|
|
var _loc7_:Number = -(_loc14_ * _loc19_ + _loc9_ * _loc18_);
|
|
var _loc12_:Number = _loc11_ * _loc19_ + _loc13_ * _loc18_;
|
|
var _loc28_:Number = -(_loc29_ * _loc21_ + _loc27_ * _loc17_);
|
|
var _loc34_:Number = _loc11_ * _loc21_ + _loc13_ * _loc17_;
|
|
if(_loc12_ <= 0 && _loc34_ <= 0)
|
|
{
|
|
param1.SetV(_loc40_);
|
|
param2.SetV(_loc41_);
|
|
_loc37_.SetV(_loc40_);
|
|
_loc36_.SetV(_loc41_);
|
|
_loc6_.SetV(_loc10_);
|
|
return 1;
|
|
}
|
|
var _loc25_:Number = _loc33_ * _loc18_ - _loc38_ * _loc19_;
|
|
var _loc20_:Number = _loc25_ * (_loc14_ * _loc27_ - _loc9_ * _loc29_);
|
|
var _loc23_:Number = _loc25_ * (_loc29_ * _loc13_ - _loc27_ * _loc11_);
|
|
if(_loc23_ <= 0 && _loc28_ >= 0 && _loc34_ >= 0 && _loc28_ + _loc34_ > 0)
|
|
{
|
|
_loc16_ = _loc28_ / (_loc28_ + _loc34_);
|
|
param1.x = _loc39_.x + _loc16_ * (_loc40_.x - _loc39_.x);
|
|
param1.y = _loc39_.y + _loc16_ * (_loc40_.y - _loc39_.y);
|
|
param2.x = _loc35_.x + _loc16_ * (_loc41_.x - _loc35_.x);
|
|
param2.y = _loc35_.y + _loc16_ * (_loc41_.y - _loc35_.y);
|
|
_loc37_.SetV(_loc40_);
|
|
_loc36_.SetV(_loc41_);
|
|
_loc6_.SetV(_loc10_);
|
|
return 2;
|
|
}
|
|
var _loc22_:Number = _loc25_ * (_loc11_ * _loc9_ - _loc13_ * _loc14_);
|
|
if(_loc22_ <= 0 && _loc7_ >= 0 && _loc12_ >= 0 && _loc7_ + _loc12_ > 0)
|
|
{
|
|
_loc16_ = _loc7_ / (_loc7_ + _loc12_);
|
|
param1.x = _loc37_.x + _loc16_ * (_loc40_.x - _loc37_.x);
|
|
param1.y = _loc37_.y + _loc16_ * (_loc40_.y - _loc37_.y);
|
|
param2.x = _loc36_.x + _loc16_ * (_loc41_.x - _loc36_.x);
|
|
param2.y = _loc36_.y + _loc16_ * (_loc41_.y - _loc36_.y);
|
|
_loc39_.SetV(_loc40_);
|
|
_loc35_.SetV(_loc41_);
|
|
_loc8_.SetV(_loc10_);
|
|
return 2;
|
|
}
|
|
var _loc15_:Number = _loc23_ + _loc22_ + _loc20_;
|
|
_loc15_ = 1 / _loc15_;
|
|
var _loc32_:Number = _loc23_ * _loc15_;
|
|
var _loc31_:Number = _loc22_ * _loc15_;
|
|
var _loc30_:Number = 1 - _loc32_ - _loc31_;
|
|
param1.x = _loc32_ * _loc37_.x + _loc31_ * _loc39_.x + _loc30_ * _loc40_.x;
|
|
param1.y = _loc32_ * _loc37_.y + _loc31_ * _loc39_.y + _loc30_ * _loc40_.y;
|
|
param2.x = _loc32_ * _loc36_.x + _loc31_ * _loc35_.x + _loc30_ * _loc41_.x;
|
|
param2.y = _loc32_ * _loc36_.y + _loc31_ * _loc35_.y + _loc30_ * _loc41_.y;
|
|
return 3;
|
|
}
|
|
|
|
public static function InPoints(param1:b2Vec2, param2:Array, param3:int) : Boolean
|
|
{
|
|
var _loc10_:int = 0;
|
|
var _loc7_:b2Vec2 = null;
|
|
var _loc6_:Number = NaN;
|
|
var _loc5_:Number = NaN;
|
|
var _loc4_:Number = NaN;
|
|
var _loc9_:Number = NaN;
|
|
var _loc8_:Number = 100 * Number.MIN_VALUE;
|
|
_loc10_ = 0;
|
|
while(_loc10_ < param3)
|
|
{
|
|
_loc7_ = param2[_loc10_];
|
|
_loc6_ = Math.abs(param1.x - _loc7_.x);
|
|
_loc5_ = Math.abs(param1.y - _loc7_.y);
|
|
_loc4_ = Math.max(Math.abs(param1.x),Math.abs(_loc7_.x));
|
|
_loc9_ = Math.max(Math.abs(param1.y),Math.abs(_loc7_.y));
|
|
if(_loc6_ < _loc8_ * (_loc4_ + 1) && _loc5_ < _loc8_ * (_loc9_ + 1))
|
|
{
|
|
return true;
|
|
}
|
|
_loc10_++;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
public static function DistanceGeneric(param1:b2Vec2, param2:b2Vec2, param3:*, param4:b2XForm, param5:*, param6:b2XForm) : Number
|
|
{
|
|
var _loc11_:b2Vec2 = null;
|
|
var _loc9_:int = 0;
|
|
_loc9_ = 20;
|
|
var _loc22_:int = 0;
|
|
var _loc20_:Number = NaN;
|
|
var _loc19_:Number = NaN;
|
|
var _loc10_:b2Vec2 = null;
|
|
var _loc13_:b2Vec2 = null;
|
|
var _loc15_:Number = NaN;
|
|
var _loc18_:Number = NaN;
|
|
var _loc14_:Number = NaN;
|
|
var _loc7_:Number = NaN;
|
|
var _loc12_:int = 0;
|
|
var _loc17_:Array = s_p1s;
|
|
var _loc16_:Array = s_p2s;
|
|
var _loc21_:Array = s_points;
|
|
var _loc23_:int = 0;
|
|
param1.SetV(param3.GetFirstVertex(param4));
|
|
param2.SetV(param5.GetFirstVertex(param6));
|
|
var _loc8_:Number = 0;
|
|
_loc22_ = 0;
|
|
while(_loc22_ < 20)
|
|
{
|
|
_loc20_ = param2.x - param1.x;
|
|
_loc19_ = param2.y - param1.y;
|
|
_loc10_ = param3.Support(param4,_loc20_,_loc19_);
|
|
_loc13_ = param5.Support(param6,-_loc20_,-_loc19_);
|
|
_loc8_ = _loc20_ * _loc20_ + _loc19_ * _loc19_;
|
|
_loc15_ = _loc13_.x - _loc10_.x;
|
|
_loc18_ = _loc13_.y - _loc10_.y;
|
|
_loc14_ = _loc20_ * _loc15_ + _loc19_ * _loc18_;
|
|
if(_loc8_ - _loc14_ <= 0.01 * _loc8_)
|
|
{
|
|
if(_loc23_ == 0)
|
|
{
|
|
param1.SetV(_loc10_);
|
|
param2.SetV(_loc13_);
|
|
}
|
|
g_GJK_Iterations = _loc22_;
|
|
return Math.sqrt(_loc8_);
|
|
}
|
|
switch(_loc23_)
|
|
{
|
|
case 0:
|
|
_loc11_ = _loc17_[0];
|
|
_loc11_.SetV(_loc10_);
|
|
_loc11_ = _loc16_[0];
|
|
_loc11_.SetV(_loc13_);
|
|
_loc11_ = _loc21_[0];
|
|
_loc11_.x = _loc15_;
|
|
_loc11_.y = _loc18_;
|
|
param1.SetV(_loc17_[0]);
|
|
param2.SetV(_loc16_[0]);
|
|
_loc23_++;
|
|
break;
|
|
case 1:
|
|
_loc11_ = _loc17_[1];
|
|
_loc11_.SetV(_loc10_);
|
|
_loc11_ = _loc16_[1];
|
|
_loc11_.SetV(_loc13_);
|
|
_loc11_ = _loc21_[1];
|
|
_loc11_.x = _loc15_;
|
|
_loc11_.y = _loc18_;
|
|
_loc23_ = ProcessTwo(param1,param2,_loc17_,_loc16_,_loc21_);
|
|
break;
|
|
case 2:
|
|
_loc11_ = _loc17_[2];
|
|
_loc11_.SetV(_loc10_);
|
|
_loc11_ = _loc16_[2];
|
|
_loc11_.SetV(_loc13_);
|
|
_loc11_ = _loc21_[2];
|
|
_loc11_.x = _loc15_;
|
|
_loc11_.y = _loc18_;
|
|
_loc23_ = ProcessThree(param1,param2,_loc17_,_loc16_,_loc21_);
|
|
}
|
|
if(_loc23_ == 3)
|
|
{
|
|
g_GJK_Iterations = _loc22_;
|
|
return 0;
|
|
}
|
|
_loc7_ = -1.7976931348623157e+308;
|
|
_loc12_ = 0;
|
|
while(_loc12_ < _loc23_)
|
|
{
|
|
_loc11_ = _loc21_[_loc12_];
|
|
_loc7_ = b2Math.b2Max(_loc7_,_loc11_.x * _loc11_.x + _loc11_.y * _loc11_.y);
|
|
_loc12_++;
|
|
}
|
|
if(_loc23_ == 3 || _loc8_ <= 100 * Number.MIN_VALUE * _loc7_)
|
|
{
|
|
g_GJK_Iterations = _loc22_;
|
|
_loc20_ = param2.x - param1.x;
|
|
_loc19_ = param2.y - param1.y;
|
|
_loc8_ = _loc20_ * _loc20_ + _loc19_ * _loc19_;
|
|
return Math.sqrt(_loc8_);
|
|
}
|
|
_loc22_++;
|
|
}
|
|
g_GJK_Iterations = 20;
|
|
return Math.sqrt(_loc8_);
|
|
}
|
|
|
|
public static function DistanceCC(param1:b2Vec2, param2:b2Vec2, param3:b2CircleShape, param4:b2XForm, param5:b2CircleShape, param6:b2XForm) : Number
|
|
{
|
|
var _loc16_:b2Mat22 = null;
|
|
var _loc10_:b2Vec2 = null;
|
|
var _loc20_:Number = NaN;
|
|
var _loc11_:Number = NaN;
|
|
_loc16_ = param4.R;
|
|
_loc10_ = param3.m_localPosition;
|
|
var _loc12_:Number = param4.position.x + (_loc16_.col1.x * _loc10_.x + _loc16_.col2.x * _loc10_.y);
|
|
var _loc19_:Number = param4.position.y + (_loc16_.col1.y * _loc10_.x + _loc16_.col2.y * _loc10_.y);
|
|
_loc16_ = param6.R;
|
|
_loc10_ = param5.m_localPosition;
|
|
var _loc15_:Number = param6.position.x + (_loc16_.col1.x * _loc10_.x + _loc16_.col2.x * _loc10_.y);
|
|
var _loc13_:Number = param6.position.y + (_loc16_.col1.y * _loc10_.x + _loc16_.col2.y * _loc10_.y);
|
|
var _loc9_:Number = _loc15_ - _loc12_;
|
|
var _loc8_:Number = _loc13_ - _loc19_;
|
|
var _loc7_:Number = _loc9_ * _loc9_ + _loc8_ * _loc8_;
|
|
var _loc17_:Number = param3.m_radius - 0.04;
|
|
var _loc18_:Number = param5.m_radius - 0.04;
|
|
var _loc14_:Number = _loc17_ + _loc18_;
|
|
if(_loc7_ > _loc14_ * _loc14_)
|
|
{
|
|
_loc20_ = Math.sqrt(_loc7_);
|
|
_loc9_ /= _loc20_;
|
|
_loc8_ /= _loc20_;
|
|
_loc11_ = _loc20_ - _loc14_;
|
|
param1.x = _loc12_ + _loc17_ * _loc9_;
|
|
param1.y = _loc19_ + _loc17_ * _loc8_;
|
|
param2.x = _loc15_ - _loc18_ * _loc9_;
|
|
param2.y = _loc13_ - _loc18_ * _loc8_;
|
|
return _loc11_;
|
|
}
|
|
if(_loc7_ > Number.MIN_VALUE * Number.MIN_VALUE)
|
|
{
|
|
_loc20_ = Math.sqrt(_loc7_);
|
|
_loc9_ /= _loc20_;
|
|
_loc8_ /= _loc20_;
|
|
param1.x = _loc12_ + _loc17_ * _loc9_;
|
|
param1.y = _loc19_ + _loc17_ * _loc8_;
|
|
param2.x = param1.x;
|
|
param2.y = param1.y;
|
|
return 0;
|
|
}
|
|
param1.x = _loc12_;
|
|
param1.y = _loc19_;
|
|
param2.x = param1.x;
|
|
param2.y = param1.y;
|
|
return 0;
|
|
}
|
|
|
|
public static function DistancePC(param1:b2Vec2, param2:b2Vec2, param3:b2PolygonShape, param4:b2XForm, param5:b2CircleShape, param6:b2XForm) : Number
|
|
{
|
|
var _loc13_:b2Mat22 = null;
|
|
var _loc9_:b2Vec2 = null;
|
|
var _loc8_:Number = NaN;
|
|
var _loc7_:Number = NaN;
|
|
var _loc14_:Number = NaN;
|
|
var _loc10_:b2Point = gPoint;
|
|
_loc9_ = param5.m_localPosition;
|
|
_loc13_ = param6.R;
|
|
_loc10_.p.x = param6.position.x + (_loc13_.col1.x * _loc9_.x + _loc13_.col2.x * _loc9_.y);
|
|
_loc10_.p.y = param6.position.y + (_loc13_.col1.y * _loc9_.x + _loc13_.col2.y * _loc9_.y);
|
|
var _loc11_:Number = DistanceGeneric(param1,param2,param3,param4,_loc10_,b2Math.b2XForm_identity);
|
|
var _loc12_:Number = param5.m_radius - 0.04;
|
|
if(_loc11_ > _loc12_)
|
|
{
|
|
_loc11_ -= _loc12_;
|
|
_loc8_ = param2.x - param1.x;
|
|
_loc7_ = param2.y - param1.y;
|
|
_loc14_ = Math.sqrt(_loc8_ * _loc8_ + _loc7_ * _loc7_);
|
|
_loc8_ /= _loc14_;
|
|
_loc7_ /= _loc14_;
|
|
param2.x -= _loc12_ * _loc8_;
|
|
param2.y -= _loc12_ * _loc7_;
|
|
}
|
|
else
|
|
{
|
|
_loc11_ = 0;
|
|
param2.x = param1.x;
|
|
param2.y = param1.y;
|
|
}
|
|
return _loc11_;
|
|
}
|
|
|
|
public static function Distance(param1:b2Vec2, param2:b2Vec2, param3:b2Shape, param4:b2XForm, param5:b2Shape, param6:b2XForm) : Number
|
|
{
|
|
var _loc7_:int = param3.m_type;
|
|
var _loc8_:int = param5.m_type;
|
|
if(_loc7_ == 0 && _loc8_ == 0)
|
|
{
|
|
return DistanceCC(param1,param2,param3 as b2CircleShape,param4,param5 as b2CircleShape,param6);
|
|
}
|
|
if(_loc7_ == 1 && _loc8_ == 0)
|
|
{
|
|
return DistancePC(param1,param2,param3 as b2PolygonShape,param4,param5 as b2CircleShape,param6);
|
|
}
|
|
if(_loc7_ == 0 && _loc8_ == 1)
|
|
{
|
|
return DistancePC(param2,param1,param5 as b2PolygonShape,param6,param3 as b2CircleShape,param4);
|
|
}
|
|
if(_loc7_ == 1 && _loc8_ == 1)
|
|
{
|
|
return DistanceGeneric(param1,param2,param3 as b2PolygonShape,param4,param5 as b2PolygonShape,param6);
|
|
}
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
|