/**
* Calculates the intersection point bnetween the current and two other planes
*
* @param Plane $plane1
* @param Plane $plane2
* @return bool|\Math_Vector3
* @throws InvalidArgumentException
*/
public function calculateIntersectionPointWithTwoPlanes(self $plane1, self $plane2)
{
$n1 = $this->normalVectorNormalized;
$n2 = $plane1->normalVectorNormalized;
$n3 = $plane2->normalVectorNormalized;
$d1 = $this->distanceToOrigin;
$d2 = $plane1->distanceToOrigin;
$d3 = $plane2->distanceToOrigin;
$n2_x_n3 = \Math_VectorOp::crossProduct($n2, $n3);
$n3_x_n1 = \Math_VectorOp::crossProduct($n3, $n1);
$n1_x_n2 = \Math_VectorOp::crossProduct($n1, $n2);
$p = new \Math_Vector3(\Math_VectorOp::add(\Math_VectorOp::add(\Math_VectorOp::scale($d1, $n2_x_n3), \Math_VectorOp::scale($d2, $n3_x_n1)), \Math_VectorOp::scale($d3, $n1_x_n2))->getTuple());
$divisor = \Math_VectorOp::dotProduct($n1, $n2_x_n3);
if ((double) 0 === $divisor) {
throw new \InvalidArgumentException('no point-intersection');
}
$p->scale(1 / $divisor);
return $p;
}
echo "Converting to a unit vector\n";
$v->normalize();
echo $v->toString() . "\n";
echo "Length after normalizing: " . $v->length() . "\n";
echo "Reversing vector\n";
$v->reverse();
echo $v->toString() . "\n";
echo "==\nVector from tuple\n";
$w = new Math_Vector($t);
echo "Cartesian distance(v,w) = " . $v->distance($w) . "\n";
echo "Manhattan distance(v,w) = " . $v->distance($w, 'manhattan') . "\n";
echo "Chessboard distance(v,w) = " . $v->distance($w, 'chessboard') . "\n";
echo "Vector v: " . $v->toString() . "\n";
echo "Vector w: " . $w->toString() . "\n";
echo "==\nVector from another vector\n";
$z = new Math_Vector(new Math_Vector(range(2, 5)));
echo $z->toString() . "\n";
echo "==\nVector3 vector\n";
$x = new Math_Vector3(new Math_Tuple(array(1, 0, 1)));
echo $x->toString() . "\n";
echo "==\nVector2 vector\n";
$y = new Math_Vector2(array(1, 3));
echo $y->toString() . "\n";
echo "==\nInvalid vector\n";
$bar = new Math_Vector("foo");
if ($bar->isValid()) {
echo "bar is good\n";
} else {
echo "bar is bad\n";
}
print_r($bar);
/**
* Takes all point vectors ("vertexes") of the polygon describing the face and sorts them
* in clockwise order.
*/
public function sortVerticesClockwise()
{
$center = $this->calculateCenter();
for ($n = 0; $n <= count($this->vertexes) - 3; $n++) {
$a = new \Math_Vector3(\Math_VectorOp::substract($this->vertexes[$n], $center)->getTuple());
$a->normalize();
$p = Plane::getInstanceByThreePositionVectors($this->vertexes[$n], $center, new \Math_Vector3(\Math_VectorOp::add($center, $this->plane->getNormalVectorNormalized())->getTuple()));
$smallestAngle = -1;
$smallest = -1;
for ($m = $n + 1; $m <= count($this->vertexes) - 1; $m++) {
if ($p->calculateSideOfPointVector($this->vertexes[$m]) !== Plane::SIDE_BACK) {
$b = new \Math_Vector3(\Math_VectorOp::substract($this->vertexes[$m], $center)->getTuple());
$b->normalize();
$angle = \Math_VectorOp::dotProduct($a, $b);
if ($angle > $smallestAngle) {
$smallestAngle = $angle;
$smallest = $m;
}
}
}
if ($smallest == -1) {
throw new \RuntimeException('Error: Degenerate polygon!');
}
//swap vertices
$temp = $this->vertexes[$n + 1];
$this->vertexes[$n + 1] = $this->vertexes[$smallest];
$this->vertexes[$smallest] = $temp;
unset($temp);
}
// Check if vertex order needs to be reversed for back-facing polygon
$newPlane = Plane::getInstanceByThreePositionVectors($this->vertexes[0], $this->vertexes[1], $this->vertexes[2]);
if (\Math_VectorOp::dotProduct($newPlane->getNormalVectorNormalized(), $this->plane->getNormalVectorNormalized()) < 0) {
array_reverse($this->vertexes);
}
}
<?php
require_once "Math/Vector/Vector.php";
require_once "Math/Vector/Vector2.php";
require_once "Math/Vector/Vector3.php";
require_once "Math/Vector/VectorOp.php";
$v1 = new Math_Vector2(array(1, 2));
$v2 = new Math_Vector2(array(2, 4));
$w1 = new Math_Vector3(array(2, 3, 1));
$w2 = new Math_Vector3(array(1, -1, 0));
$w3 = new Math_Vector3(array(7, 3, 2));
echo date("Y-m-d H:i:s") . "\n";
echo "==\nVector v1: " . $v1->toString() . "\n";
echo "Vector v2: " . $v2->toString() . "\n";
$r = Math_VectorOp::add($v1, $v2);
echo "v1 + v2: " . $r->toString() . "\n";
$r = Math_VectorOp::substract($v1, $v2);
echo "v1 - v2: " . $r->toString() . "\n";
$r = Math_VectorOp::multiply($v1, $v2);
echo "v1 * v2: " . $r->toString() . "\n";
$r = Math_VectorOp::divide($v1, $v2);
echo "v1 / v2: " . $r->toString() . "\n";
echo "==\nVector w1: " . $w1->toString() . "\n";
echo "Vector w2: " . $w2->toString() . "\n";
echo "Vector w3: " . $w3->toString() . "\n";
$r = Math_VectorOp::scale(2.0, $w1);
echo " 2.0 * w1 = " . $r->toString() . "\n";
$r = Math_VectorOp::dotProduct($w1, $w2);
echo "w1 . w2 = {$r}\n";
$r = Math_VectorOp::crossProduct($w2, $w3);
echo "w2 x w3 = " . $r->toString() . "\n";
