NostalgiaCore/src/math/Vector3.php
2024-08-17 16:21:02 +03:00

273 lines
6.1 KiB
PHP

<?php
class Vector3{
public $x, $y, $z;
public function __construct($x = 0, $y = 0, $z = 0){
$this->x = $x;
$this->y = $y;
$this->z = $z;
}
public function setXYZ($x, $y, $z){
$this->x = $x;
$this->y = $y;
$this->z = $z;
}
public function copy(){
return new Vector3($this->x, $this->y, $this->z);
}
public function toArray(){
return ["x" => $this->x, "y" => $this->y, "z" => $this->z];
}
public function getFloorX(){
return (int) $this->x;
}
public function getFloorY(){
return (int) $this->y;
}
public function getFloorZ(){
return (int) $this->z;
}
public function getRight(){
return $this->getX();
}
public function getX(){
return $this->x;
}
public function getUp(){
return $this->getY();
}
public function getY(){
return $this->y;
}
public function getForward(){
return $this->getZ();
}
public function getZ(){
return $this->z;
}
public function getSouth(){
return $this->getX();
}
public function getWest(){
return $this->getZ();
}
public function subtract($x = 0, $y = 0, $z = 0){
if(($x instanceof Vector3) === true){
return $this->subtract($x->x, $x->y, $x->z);
}else{
return new Vector3($this->x - $x, $this->y - $y, $this->z - $z);
}
}
public function add($x = 0, $y = 0, $z = 0){
if(($x instanceof Vector3) === true){
return $this->add($x->x, $x->y, $x->z);
}else{
return new Vector3($this->x + $x, $this->y + $y, $this->z + $z);
}
}
public function multiply($number){
return new Vector3($this->x * $number, $this->y * $number, $this->z * $number);
}
public function ceil(){
return new Vector3((int) ($this->x + 1), (int) ($this->y + 1), (int) ($this->z + 1));
}
public function floor(){
return new Vector3((int) $this->x, (int) $this->y, (int) $this->z);
}
public function round(){
return new Vector3(round($this->x), round($this->y), round($this->z));
}
public function abs(){
return new Vector3(abs($this->x), abs($this->y), abs($this->z));
}
public function getSide($side, $step = 1){
return match ((int)$side) {
0 => new Vector3($this->x, $this->y - $step, $this->z),
1 => new Vector3($this->x, $this->y + $step, $this->z),
2 => new Vector3($this->x, $this->y, $this->z - $step),
3 => new Vector3($this->x, $this->y, $this->z + $step),
4 => new Vector3($this->x - $step, $this->y, $this->z),
5 => new Vector3($this->x + $step, $this->y, $this->z),
default => $this,
};
}
public function distance($x = 0, $y = 0, $z = 0){
if(($x instanceof Vector3) === true){
return sqrt($this->distanceSquared($x->x, $x->y, $x->z));
}else{
return sqrt($this->distanceSquared($x, $y, $z));
}
}
public function distanceSquared($x = 0, $y = 0, $z = 0){
if($x instanceof Vector3){
return $this->distanceSquared($x->x, $x->y, $x->z);
}else{
return ($this->x - $x)*($this->x - $x) + ($this->y - $y)*($this->y - $y) + ($this->z - $z)*($this->z - $z);
}
}
public function maxPlainDistance($x = 0, $z = 0){
if(($x instanceof Vector3) === true){
return $this->maxPlainDistance($x->x, $x->z);
}else{
return max(abs($this->x - $x), abs($this->z - $z));
}
}
public function normalize(){
$len = $this->length();
if($len != 0){
return $this->divide($len);
}
return new Vector3(0, 0, 0);
}
public function length(){
return sqrt($this->lengthSquared());
}
public function lengthSquared(){
return $this->x * $this->x + $this->y * $this->y + $this->z * $this->z;
}
public function divide($number){
return new Vector3($this->x / $number, $this->y / $number, $this->z / $number);
}
public function dot(Vector3 $v){
return $this->x * $v->x + $this->y * $v->y + $this->z * $v->z;
}
public function cross(Vector3 $v){
return new Vector3(
$this->y * $v->z - $this->z * $v->y,
$this->z * $v->x - $this->x * $v->z,
$this->x * $v->y - $this->y * $v->x
);
}
public static function fromArray($arr){
return new Vector3($arr[0], $arr[1], $arr[2]);
}
public function __toString(){
return "Vector3(x=" . $this->x . ",y=" . $this->y . ",z=" . $this->z . ")";
}
/**
* Returns a new vector with x value equal to the second parameter, along the line between this vector and the
* passed in vector, or null if not possible.
*
* @param Vector3 $v
* @param float $x
*
* @return Vector3
*/
public function clipX(Vector3 $v, $x){
$xDiff = $v->x - $this->x;
$yDiff = $v->y - $this->y;
$zDiff = $v->z - $this->z;
if(($xDiff * $xDiff) < 0.0000001){
return null;
}
$f = ($x - $this->x) / $xDiff;
if($f < 0 or $f > 1){
return null;
}else{
return new Vector3($this->x + $xDiff * $f, $this->y + $yDiff * $f, $this->z + $zDiff * $f);
}
}
public function getIntermediateWithXValue(Vector3 $v, $y){
return $this->clipX($v, $y);
}
/**
* Returns a new vector with y value equal to the second parameter, along the line between this vector and the
* passed in vector, or null if not possible.
*
* @param Vector3 $v
* @param float $y
*
* @return Vector3
*/
public function clipY(Vector3 $v, $y){
$xDiff = $v->x - $this->x;
$yDiff = $v->y - $this->y;
$zDiff = $v->z - $this->z;
if(($yDiff * $yDiff) < 0.0000001){
return null;
}
$f = ($y - $this->y) / $yDiff;
if($f < 0 or $f > 1){
return null;
}else{
return new Vector3($this->x + $xDiff * $f, $this->y + $yDiff * $f, $this->z + $zDiff * $f);
}
}
public function getIntermediateWithYValue(Vector3 $v, $y){
return $this->clipY($v, $y);
}
/**
* Returns a new vector with z value equal to the second parameter, along the line between this vector and the
* passed in vector, or null if not possible.
*
* @param Vector3 $v
* @param float $z
*
* @return Vector3
*/
public function clipZ(Vector3 $v, $z){
$xDiff = $v->x - $this->x;
$yDiff = $v->y - $this->y;
$zDiff = $v->z - $this->z;
if(($zDiff * $zDiff) < 0.0000001){
return null;
}
$f = ($z - $this->z) / $zDiff;
if($f < 0 or $f > 1){
return null;
}else{
return new Vector3($this->x + $xDiff * $f, $this->y + $yDiff * $f, $this->z + $zDiff * $f);
}
}
public function getIntermediateWithZValue(Vector3 $v, $y){
return $this->clipZ($v, $y);
}
}