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

Compare commits

base: ulysse:9f3f039bb0a248448555c7c1a7f1a1c9985ecc83
Branches Tags
ulysse:main
...
compare: ulysse:27733e737ad82ad5a35a1c71fe35c2d6f0f79b5a
Branches Tags
ulysse:main

6 Commits
9f3f039bb0 ... 27733e737a

Author SHA1 Message Date
Ulysse Cura 27733e737a Nettoyage de code et changement de valeurs pour toujours "plus" de précision. 2025-02-01 16:53:59 +01:00
Ulysse Cura 420e49086c Merge branch 'mon_travail' into main 
# Conflicts:
#    Main.ino
 2025-02-01 15:11:17 +01:00
Ulysse Cura 3c80ada3d7 Changement de valeurs. 2025-02-01 14:33:41 +01:00
Ulysse Cura cd937c5e50 Normalisation des vitesses. 2025-02-01 13:51:15 +01:00
Ulysse Cura a2d0072635 Nettoyage de code 2025-02-01 12:17:32 +01:00
Ulysse Cura c9c98375c7 Couleur et gyroscope corrigés 2025-02-01 12:14:05 +01:00
2 changed files with 29 additions and 19 deletions
Show Stats Expand all files Collapse all files

9
IO.hpp
View File

@ -67,7 +67,7 @@ class IO {
pinMode(PIN_TIRETTE, INPUT_PULLUP);
pinMode(PIN_BUTTON_COLOR, INPUT_PULLUP);
m_code_cell->Motion_RotationRead(m_init_x, m_init_y, m_init_z);
initGyroscope();
m_initMotors();
m_initServo();
@ -84,6 +84,11 @@ class IO {
return nb_errors;
}
void initGyroscope()
{
m_code_cell->Motion_RotationRead(m_init_x, m_init_y, m_init_z);
}
int update()
{
static unsigned long last_color_change_time {0};
@ -122,7 +127,7 @@ class IO {
m_is_tirette_pulled = (digitalRead(PIN_TIRETTE) == HIGH);
m_is_color_blue = is_color_blue;
is_color_blue = (digitalRead(PIN_BUTTON_COLOR) == HIGH);
is_color_blue = (digitalRead(PIN_BUTTON_COLOR) == LOW);
if(m_is_motor_control_activated)
{

39
Main.ino
View File

@ -5,6 +5,10 @@
#include "IO.hpp"
#define NORMAL_SPEED 2048.0f
#define TURNING_SPEED 1500.0f
#define ON_STAGE_SPEED 1120.0f
// Unit tests activation
//#define UNIT_TESTS
@ -108,43 +112,35 @@ void loop()
case State::WaitingTimer:
static unsigned long initial_time = millis();
//if(millis() - initial_time >= 90000)
if(millis() - initial_time >= 2000)
if(millis() - initial_time >= 87000)
//if(millis() - initial_time >= 2000)
{
my_IO.initGyroscope();
actual_state = State::ForwardToRamp;
}
break;
case State::ForwardToRamp:
my_IO.motorControlOn();
my_IO.setSpeed(2048.0f);
my_IO.setSpeed(2000.0f);
if(my_IO.getAngle(Axes::Y) < -5.0f)
if(my_IO.getAngle(Axes::Y) < -8.0f)
{
actual_state = State::ForwardToScene;
}
break;
case State::ForwardToScene:
my_IO.setSpeed(2048.0f);
if(my_IO.getAngle(Axes::Y) > -5.0f)
my_IO.setSpeed(2000.0f);
if(my_IO.getAngle(Axes::Y) > -3.5f)
{
my_IO.setSpeed(1300.0f);
actual_state = my_IO.isSelectedColorBlue() ? State::Turn90Blue : State::Turn90Yellow;
//actual_state = State::Dancing;
}
break;
case State::Turn90Blue:
my_IO.setDirWithAngularSpeed(-90.0f);
if(my_IO.getAngle(Axes::Z) < -80.0f)
{
actual_state = State::ForwardToSceneEdge;
}
break;
case State::Turn90Yellow:
my_IO.setDirWithAngularSpeed(90.0f);
if(my_IO.getAngle(Axes::Z) >= 80.0f)
@ -153,10 +149,19 @@ void loop()
}
break;
case State::Turn90Yellow:
my_IO.setDirWithAngularSpeed(-90.0f);
if(my_IO.getAngle(Axes::Z) <= -80.0f)
{
actual_state = State::ForwardToSceneEdge;
}
break;
case State::ForwardToSceneEdge:
my_IO.setSpeed(1100.0f);
if(my_IO.getAngle(Axes::Y) > 5.0f)
if(my_IO.getAngle(Axes::Y) > 3.0f)
{
actual_state = State::Dancing;
}