DashyFox/PingPong
1
0
Fork 0
mirror of https://github.com/DashyFox/StackSport.git synced 2025-05-04 15:20:16 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

fix program switch

Browse Source
This commit is contained in:
DashyFox 2024-09-25 03:25:12 +03:00
parent 31a74305f6
commit d9ad8667cc
1 changed files with 18 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

25
Core/Src/RobotFunctions.c
View File

@ -147,7 +147,6 @@ void BallEXT() {
ballReact_timer = millis(); ballReact_timer = millis();
} }
void RobotTick() { void RobotTick() {
BallEXT_Handler(); BallEXT_Handler();
@ -348,7 +347,6 @@ uint8_t loadProgramFromMacro(CurrentMacro *currentMacro) {
return 0; return 0;
} }
uint8_t programId = currentMacro->macro.programs[currentProgIndexLocal].id; uint8_t programId = currentMacro->macro.programs[currentProgIndexLocal].id;
currentMacro->currentProgram.indexGlobal = programId; currentMacro->currentProgram.indexGlobal = programId;
getProg(programId, &program_); getProg(programId, &program_);
@ -364,11 +362,12 @@ uint8_t loadProgramFromMacro(CurrentMacro *currentMacro) {
&& currentMacro->macro.programs[currentProgIndexLocal].speedScrew && currentMacro->macro.programs[currentProgIndexLocal].speedScrew
!= 0; != 0;
if (needOverride) if (needOverride) {
{
print("Override programs params\n"); print("Override programs params\n");
program_.header.countRepeat = currentMacro->macro.programs[currentProgIndexLocal].countRepeat; program_.header.countRepeat =
program_.header.options = currentMacro->macro.programs[currentProgIndexLocal].options; currentMacro->macro.programs[currentProgIndexLocal].countRepeat;
program_.header.options =
currentMacro->macro.programs[currentProgIndexLocal].options;
for (uint8_t i = 0; i < program_.header.shotCount; i++) { for (uint8_t i = 0; i < program_.header.shotCount; i++) {
program_.shots[i].speedScrew = program_.shots[i].speedScrew =
currentMacro->macro.programs[currentProgIndexLocal].speedScrew; currentMacro->macro.programs[currentProgIndexLocal].speedScrew;
@ -378,6 +377,7 @@ uint8_t loadProgramFromMacro(CurrentMacro *currentMacro) {
currentMacro->currentProgram.currentShotIndexLocal = 0; currentMacro->currentProgram.currentShotIndexLocal = 0;
currentMacro->currentProgram.currentBallCount = 0; currentMacro->currentProgram.currentBallCount = 0;
loadShotFromProgram(&currentMacro->currentProgram);
return 1; return 1;
} }
@ -412,15 +412,15 @@ uint8_t nextBallInShot(CurrentShot *shot) {
} }
} }
uint8_t nextShotInProgram(CurrentProgram *prog) { uint8_t nextShotInProgram(CurrentProgram *prog) {
uint8_t shotApply_f = 0;
if (nextBallInShot(&prog->currentShot)) { if (nextBallInShot(&prog->currentShot)) {
print("\nSwitch shot\n"); print("\nSwitch shot\n");
if (!loadNextShotInProgram(prog)) { if (!loadNextShotInProgram(prog)) {
print("loadNextShotInProgram ERR\n"); print("loadNextShotInProgram ERR\n");
return 0; return 0;
} }
shotApply(&prog->currentShot); shotApply_f = 1;
} }
// Проверка на завершение программы // Проверка на завершение программы
@ -431,18 +431,21 @@ uint8_t nextShotInProgram(CurrentProgram *prog) {
print("Program DONE\n"); print("Program DONE\n");
return 1; return 1;
} }
if (shotApply_f)
shotApply(&prog->currentShot);
return 0; return 0;
} }
uint8_t nextProgramInMacro(CurrentMacro *currentMacro) { uint8_t nextProgramInMacro(CurrentMacro *currentMacro) {
// uint8_t shotApply_f = 0;
if (nextShotInProgram(&currentMacro->currentProgram)) { if (nextShotInProgram(&currentMacro->currentProgram)) {
print("\nSwitch program\n"); print("\nSwitch program\n");
if (!loadNextProgramInMacro(currentMacro)) { if (!loadNextProgramInMacro(currentMacro)) {
print("loadNextProgramInMacro ERR\n"); print("loadNextProgramInMacro ERR\n");
return 0; return 0;
} }
// shotApply(&currentMacro->currentProgram.currentShot); shotApply(&currentMacro->currentProgram.currentShot);
// shotApply_f = 1;
} }
// Проверка на завершение макро // Проверка на завершение макро
@ -451,6 +454,8 @@ uint8_t nextProgramInMacro(CurrentMacro *currentMacro) {
// print("Macro DONE\n"); // print("Macro DONE\n");
// return 1; // return 1;
// } // }
// if (shotApply_f)
// shotApply(&currentMacro->currentProgram.currentShot);
return 0; return 0;
} }