I have a 3D shape defined in STL file and I'd like to rotate it around its axis/center using Yaw, Pitch and Roll. However, I've already implemented a solution and it doesn't work as expected as it rotates the 3D shape around the origin axis instead. Here's what I've done so far (written in PHP):
function rotate($vertices, $roll = 0, $pitch = 0, $yaw = 0)
{
if(!empty($vertices))
{
$cosa = cos($yaw);
$sina = sin($yaw);
$cosb = cos($pitch);
$sinb = sin($pitch);
$cosc = cos($roll);
$sinc = sin($roll);
$Axx = $cosa * $cosb;
$Axy = $cosa * $sinb * $sinc - $sina * $cosc;
$Axz = $cosa * $sinb * $cosc + $sina * $sinc;
$Ayx = $sina * $cosb;
$Ayy = $sina * $sinb * $sinc + $cosa * $cosc;
$Ayz = $sina * $sinb * $cosc - $cosa * $sinc;
$Azx = -$sinb;
$Azy = $cosb * $sinc;
$Azz = $cosb * $cosc;
//loop through all triangles
foreach($vertices as $i => $vertex)
{
$px = $vertex->x;
$py = $vertex->y;
$pz = $vertex->z;
$points =
[
'x' => ($Axx * $px + $Axy * $py + $Axz * $pz),
'y' => ($Ayx * $px + $Ayy * $py + $Ayz * $pz),
'z' => ($Azx * $px + $Azy * $py + $Azz * $pz)
];
//update the vertex
$vertices[$i]->setVertex($vi, $points);
}
}
return $vertices;
}
Please let me know if I'm missing something. any help would be appreciated.
$c
), isn't the origin, you can move the object before rotating:$px = $vertex->x - $c->x
and so on. After rotating, move it back:'x' => ($Axx * $px + $Axy * $py + $Axz * $pz) + $c->x
, ...