julien.oculi/technoshop.laser_turret_debug
1
0
Fork 0
Code Issues Pull requests Actions Packages Projects Releases Wiki Activity

feat!: update turret axis geometric model

Browse source
This commit is contained in:
Julien Oculi 2025-06-05 16:01:52 +02:00
parent 3e745059a2
commit 547d51dfc7
1 changed files with 4 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

8
maths.cpp
View file

@ -20,14 +20,14 @@ void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY,
double offsetY = 21.0; // laser to stand double offsetY = 21.0; // laser to stand
double offsetX = 0.0; // unused double offsetX = 0.0; // unused
x = -x; // natural axis direction // x = -x; // natural axis direction
y = -y; // natural axis direction
double dX = x + offsetX; double dX = x + offsetX;
double dY = y + offsetY; double dY = y + offsetY;
double dZ = z + distance; double dZ = z + distance;
double rho = sqrt(pow(dX, 2.0) + pow(dY, 2.0) + pow(dZ, 2.0)); double angleY = atan2(dZ, dY) - M_PI / 2;
double angleY = M_PI / 2.0 - acos(dY / rho); double angleX = atan2(dZ, dX) - M_PI / 2;
double angleX = atan2(dX, dZ);
angleToStep(stepX, stepY, angleX, angleY); angleToStep(stepX, stepY, angleX, angleY);
} }