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

style: apply fmt with clang-format

Browse source
This commit is contained in:
Julien Oculi 2025-06-05 15:27:35 +02:00
parent 3ef45566d5
commit 5575f0cb3c
5 changed files with 93 additions and 108 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

12
maths.cpp
View file

@ -3,13 +3,9 @@
// rollH atan((22.5 - 18.5) / 236) ~0.97°
// rollV ~1°
double degToRad(double deg) {
return deg * M_PI / 180.0;
}
double degToRad(double deg) { return deg * M_PI / 180.0; }
double radToDeg(double rad) {
return rad * 180.0 / M_PI;
}
double radToDeg(double rad) { return rad * 180.0 / M_PI; }
void angleToStep(long &stepX, long &stepY, double angleX, double angleY) {
// TODO remove magic numbers
@ -25,7 +21,8 @@ double rollCorrection(double x, double max, double width) {
return x - correction;
}
void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY, double x, double y, double z) {
void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY,
double x, double y, double z) {
// TODO remove magic numbers
double distance = 166.0; // turret to screen
double offsetY = 21.0; // laser to stand
@ -36,7 +33,6 @@ void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY, doub
double dY = rollCorrection(y + offsetY, 0.2, 400.0);
double dZ = z + distance;
double roll = atan2(4.0, 236.0);
double rollY = dX * tan(roll);
double rollX = dY * tan(roll);

3
maths.h
View file

@ -1,4 +1,5 @@
double degToRad(double deg);
double radToDeg(double rad);
void angleToStep(long &stepX, long &stepY, double angleX, double angleY);
void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY, double x, double y, double z);
void cartesianToPolar(long &stepX, long &stepY, double zeroX, double zeroY,
double x, double y, double z);

49
turret.cpp
View file

@ -1,12 +1,13 @@
#include <kissStepper.h>
#include "config.h"
#include "turret.h"
#include "config.h"
#include "maths.h"
#include <kissStepper.h>
Turret::Turret(
int pin_x_direction, int pin_x_pulse, int pin_x_enable, int pin_x_home,
int pin_y_direction, int pin_y_pulse, int pin_y_enable, int pin_y_home,
int pin_laser) : _stepperX(pin_x_direction, pin_x_pulse, pin_x_enable), _stepperY(pin_y_direction, pin_y_pulse, pin_y_enable) {
Turret::Turret(int pin_x_direction, int pin_x_pulse, int pin_x_enable,
int pin_x_home, int pin_y_direction, int pin_y_pulse,
int pin_y_enable, int pin_y_home, int pin_laser)
: _stepperX(pin_x_direction, pin_x_pulse, pin_x_enable),
_stepperY(pin_y_direction, pin_y_pulse, pin_y_enable) {
_pin_x_direction = pin_x_direction;
_pin_x_pulse = pin_x_pulse;
@ -80,9 +81,12 @@ Turret& Turret::gotoZero() {
bool yStop = false;
while (true) {
if (xStop && yStop) break;
if (!xStop) xStop = _stepperY.move() == STATE_STOPPED;
if (!yStop) yStop = _stepperX.move() == STATE_STOPPED;
if (xStop && yStop)
break;
if (!xStop)
xStop = _stepperY.move() == STATE_STOPPED;
if (!yStop)
yStop = _stepperX.move() == STATE_STOPPED;
}
_zeroX = _stepperX.getPos();
@ -102,7 +106,8 @@ Turret& Turret::moveTo(double x, double y, double z, Unit unit) {
long stepY;
if (unit == Unit::MM) {
cartesianToPolar(stepX, stepY, _zeroX, _zeroY, x / 10.0, y / 10.0, z / 10.0);
cartesianToPolar(stepX, stepY, _zeroX, _zeroY, x / 10.0, y / 10.0,
z / 10.0);
}
if (unit == Unit::CM) {
@ -110,7 +115,8 @@ Turret& Turret::moveTo(double x, double y, double z, Unit unit) {
}
if (unit == Unit::M) {
cartesianToPolar(stepX, stepY, _zeroX, _zeroY, x * 100.0, y * 100.0, z * 100.0);
cartesianToPolar(stepX, stepY, _zeroX, _zeroY, x * 100.0, y * 100.0,
z * 100.0);
}
if (unit == Unit::STEP) {
@ -134,9 +140,12 @@ Turret& Turret::moveTo(double x, double y, double z, Unit unit) {
bool yStop = false;
while (true) {
if (xStop && yStop) break;
if (!xStop) xStop = _stepperX.move() == STATE_STOPPED;
if (!yStop) yStop = _stepperY.move() == STATE_STOPPED;
if (xStop && yStop)
break;
if (!xStop)
xStop = _stepperX.move() == STATE_STOPPED;
if (!yStop)
yStop = _stepperY.move() == STATE_STOPPED;
}
_currentX = x;
@ -177,17 +186,11 @@ Turret& Turret::moveToZ(double z, Unit unit) {
return moveTo(_currentX, _currentY, z, unit);
}
Turret& Turret::moveByX(double x, Unit unit) {
return moveBy(x, 0, 0, unit);
}
Turret &Turret::moveByX(double x, Unit unit) { return moveBy(x, 0, 0, unit); }
Turret& Turret::moveByY(double y, Unit unit) {
return moveTo(0, y, 0, unit);
}
Turret &Turret::moveByY(double y, Unit unit) { return moveTo(0, y, 0, unit); }
Turret& Turret::moveByZ(double z, Unit unit) {
return moveTo(0, 0, z, unit);
}
Turret &Turret::moveByZ(double z, Unit unit) { return moveTo(0, 0, z, unit); }
Turret &Turret::getPosition(double &x, double &y, double &z, Unit unit) {
// TODO implement

17
turret.h
View file

@ -5,21 +5,11 @@
class Turret {
public:
enum Unit { MM, CM, M, RAD, DEG, STEP };
enum Unit {
MM,
CM,
M,
RAD,
DEG,
STEP
};
Turret(
int pin_x_direction, int pin_x_pulse, int pin_x_enable, int pin_x_home,
Turret(int pin_x_direction, int pin_x_pulse, int pin_x_enable, int pin_x_home,
int pin_y_direction, int pin_y_pulse, int pin_y_enable, int pin_y_home,
int pin_laser
);
int pin_laser);
Turret &init();
Turret &gotoHome();
@ -46,7 +36,6 @@ class Turret {
Turret &laserOff();
private:
kissStepper _stepperX;
kissStepper _stepperY;

10
turret_debug.ino
View file

@ -1,11 +1,9 @@
#include "config.h"
#include "turret.h"
Turret turret(
PIN_X_DIRECTION, PIN_X_PULSE, PIN_X_ENABLE, PIN_X_HOME,
Turret turret(PIN_X_DIRECTION, PIN_X_PULSE, PIN_X_ENABLE, PIN_X_HOME,
PIN_Y_DIRECTION, PIN_Y_PULSE, PIN_Y_ENABLE, PIN_Y_HOME,
PIN_LASER
);
PIN_LASER);
void setup() {
turret.init();
@ -95,6 +93,4 @@ void setup() {
turret.gotoZero();
}
void loop() {
}
void loop() {}