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