jeka/MyOwnEtherCATDevice
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Adaptive max cycle time adjustment, use maxCycleTime

Browse Source
This commit is contained in:
Hakan Bastedt
2024-04-03 21:21:51 +02:00
parent 294831465b
commit 34e60e43d8
1 changed files with 4 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
Firmware/src/main.cpp
View File

@@ -118,10 +118,10 @@ void handleStepper(void)
Obj.ActualPosition1 = Step->stepgen_array[0].pos_fb; Obj.ActualPosition1 = Step->stepgen_array[0].pos_fb;
Obj.ActualPosition2 = Step->stepgen_array[1].pos_fb; Obj.ActualPosition2 = Step->stepgen_array[1].pos_fb;
uint32_t diffT = longTime.extendTime(micros()) - irqTime; uint32_t diffT = longTime.extendTime(micros()) - irqTime;
delayT = 500 - diffT; delayT = maxCycleTime + 50 - diffT - jitterThisCycle; // Add 50 as some saftey margin
if (delayT > 0 && delayT < 900) if (delayT > 0 && delayT < 900)
{ {
syncTimer->setOverflow(delayT, MICROSEC_FORMAT); syncTimer->setOverflow(delayT, MICROSEC_FORMAT); // Work in flawed units, its ok
syncTimer->refresh(); syncTimer->refresh();
syncTimer->resume(); syncTimer->resume();
} }
@@ -247,12 +247,8 @@ void sync0Handler(void)
{ {
irqTime = longTime.extendTime(micros()); irqTime = longTime.extendTime(micros());
ALEventIRQ = ESC_ALeventread(); ALEventIRQ = ESC_ALeventread();
// if (ALEventIRQ & ESCREG_ALEVENT_SM2) serveIRQ = 1;
{ irqCnt++;
serveIRQ = 1;
irqCnt++;
}
} }
// Enable SM2 interrupts // Enable SM2 interrupts