ulysse
/
PAMI_Super_Star_2025
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Compare commits

base: ulysse:aae4cf7af7cd23f71a4218aefbee7697f4d01f89
Branches Tags
ulysse:main
..
compare: ulysse:0f647cec10b88656a2a81067c907cdbd52bec420
Branches Tags
ulysse:main

No commits in common. "aae4cf7af7cd23f71a4218aefbee7697f4d01f89" and "0f647cec10b88656a2a81067c907cdbd52bec420" have entirely different histories.
aae4cf7af7 ... 0f647cec10

1 changed files with 289 additions and 292 deletions
Show Stats Expand all files Collapse all files

39
IO.hpp
View File

@ -3,9 +3,10 @@
Thibaut Ferrand / Ulysse Cura
*/
#include <Adafruit_SSD1306.h>
#include "esp32-hal.h"
#include <CodeCell.h>
#include <ESP32Servo.h>
#include <Adafruit_SSD1306.h>
#include <cmath>
#define PIN_TIRETTE 5
@ -16,7 +17,7 @@
#define DANCING_ACTION_DELTA_ANGLE 2
#define GAIN_KD 50
#define GAIN_KD 100
#define ANGULAR_SPEED 10 // °/s
using std::abs;
@ -29,26 +30,23 @@ enum class Axes {
class Motor {
public:
int init(int pin, int channel)
int init(int pin)
{
m_pin = pin;
m_channel = channel;
pinMode(m_pin, OUTPUT);
ledcAttachChannel(m_pin, 5000, 12, m_channel);
ledcWriteChannel(m_channel, 0);
//ledcSetup(m_channel, 5000, 12); // Channel, Frequency, Resolution
//ledcAttachPin(m_pin, m_channel); // Attach pin to channel
analogWriteFrequency(m_pin, 5000);
analogWriteResolution(m_pin, 12);
analogWrite(m_pin, 0);
return 0;
}
void setSpeed(int speed)
{
if(speed > 4095) speed = 4095;
ledcWriteChannel(m_channel, speed);
analogWrite(m_pin, speed);
}
private:
@ -127,6 +125,8 @@ class IO {
float err_dir = dir - m_dir;
float angular_displacement = angular_speed * static_cast<float>(millis() / 1000 - prev_time / 1000);
Serial.printf("Angular Speed : %d\nStatic Cast : %d\nprev_time : %d\n millis : %d\n", angular_speed, static_cast<float>(millis() / 1000 - prev_time / 1000), prev_time, millis());
if(abs(err_dir) < angular_displacement)
{
m_dir = dir;
@ -136,6 +136,8 @@ class IO {
m_dir += angular_displacement * (err_dir < 0) ? -1 : 1;
}
Serial.printf("Angle : %d\nAngular Displacement : %d\n", m_dir, angular_displacement);
prev_time = millis();
}
@ -178,17 +180,14 @@ class IO {
return &m_screen;
}
Motor *getMotor(int motor)
{
return &(m_motors[motor]);
}
Motor m_motors[2];
private:
// Init Motors
void m_initMotors()
{
m_motors[0].init(PIN_MOTOR1, 0);
m_motors[1].init(PIN_MOTOR2, 1);
m_motors[0].init(PIN_MOTOR1);
m_motors[1].init(PIN_MOTOR2);
}
// Init Servo
@ -200,7 +199,6 @@ class IO {
m_servo.write(87);
}
// Init Screen
int m_initScreen()
{
if(!m_screen.begin(SSD1306_SWITCHCAPVCC, 0x3C))
@ -257,12 +255,12 @@ class IO {
if(m1_speed < 0)
{
m1_speed = 0;
//m2_speed = static_cast<int>(m_speed - 2 * correction);
m2_speed = static_cast<int>(m_speed - 2 * correction);
}
else if(m2_speed < 0)
{
m2_speed = 0;
//m1_speed = static_cast<int>(m_speed + 2 * correction);
m1_speed = static_cast<int>(m_speed + 2 * correction);
}
m_motors[0].setSpeed(m1_speed);
@ -279,7 +277,6 @@ class IO {
bool m_is_color_blue {false};
bool m_is_dancing {false};
Motor m_motors[2];
Servo m_servo;
Adafruit_SSD1306 m_screen {128, 64, &Wire, -1};