X-Ryl669
4 years ago
committed by
Scott Lahteine
Scott Lahteine
11 changed files with 276 additions and 91 deletions
@ -0,0 +1,176 @@ |
|||||
|
/**
|
||||
|
* Marlin 3D Printer Firmware |
||||
|
* Copyright (c) 2020 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
||||
|
* |
||||
|
* Based on Sprinter and grbl. |
||||
|
* Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm |
||||
|
* |
||||
|
* This program is free software: you can redistribute it and/or modify |
||||
|
* it under the terms of the GNU General Public License as published by |
||||
|
* the Free Software Foundation, either version 3 of the License, or |
||||
|
* (at your option) any later version. |
||||
|
* |
||||
|
* This program is distributed in the hope that it will be useful, |
||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
||||
|
* GNU General Public License for more details. |
||||
|
* |
||||
|
* You should have received a copy of the GNU General Public License |
||||
|
* along with this program. If not, see <https://www.gnu.org/licenses/>.
|
||||
|
* |
||||
|
*/ |
||||
|
#include "Delay.h" |
||||
|
|
||||
|
#include "../../inc/MarlinConfig.h" |
||||
|
|
||||
|
#if defined(__arm__) || defined(__thumb__) |
||||
|
|
||||
|
static uint32_t ASM_CYCLES_PER_ITERATION = 4; // Initial bet which will be adjusted in calibrate_delay_loop
|
||||
|
|
||||
|
// Simple assembler loop counting down
|
||||
|
void delay_asm(uint32_t cy) { |
||||
|
cy = _MAX(cy / ASM_CYCLES_PER_ITERATION, 1U); // Zero is forbidden here
|
||||
|
__asm__ __volatile__( |
||||
|
A(".syntax unified") // is to prevent CM0,CM1 non-unified syntax
|
||||
|
L("1") |
||||
|
A("subs %[cnt],#1") |
||||
|
A("bne 1b") |
||||
|
: [cnt]"+r"(cy) // output: +r means input+output
|
||||
|
: // input:
|
||||
|
: "cc" // clobbers:
|
||||
|
); |
||||
|
} |
||||
|
|
||||
|
// We can't use CMSIS since it's not available on all platform, so fallback to hardcoded register values
|
||||
|
#define HW_REG(X) *(volatile uint32_t *)(X) |
||||
|
#define _DWT_CTRL 0xE0001000 |
||||
|
#define _DWT_CYCCNT 0xE0001004 // CYCCNT is 32bits, takes 37s or so to wrap.
|
||||
|
#define _DEM_CR 0xE000EDFC |
||||
|
#define _LAR 0xE0001FB0 |
||||
|
|
||||
|
// Use hardware cycle counter instead, it's much safer
|
||||
|
void delay_dwt(uint32_t count) { |
||||
|
// Reuse the ASM_CYCLES_PER_ITERATION variable to avoid wasting another useless variable
|
||||
|
register uint32_t start = HW_REG(_DWT_CYCCNT) - ASM_CYCLES_PER_ITERATION, elapsed; |
||||
|
do { |
||||
|
elapsed = HW_REG(_DWT_CYCCNT) - start; |
||||
|
} while (elapsed < count); |
||||
|
} |
||||
|
|
||||
|
// Pointer to asm function, calling the functions has a ~20 cycles overhead
|
||||
|
DelayImpl DelayCycleFnc = delay_asm; |
||||
|
|
||||
|
void calibrate_delay_loop() { |
||||
|
// Check if we have a working DWT implementation in the CPU (see https://developer.arm.com/documentation/ddi0439/b/Data-Watchpoint-and-Trace-Unit/DWT-Programmers-Model)
|
||||
|
if (!HW_REG(_DWT_CTRL)) { |
||||
|
// No DWT present, so fallback to plain old ASM nop counting
|
||||
|
// Unfortunately, we don't exactly know how many iteration it'll take to decrement a counter in a loop
|
||||
|
// It depends on the CPU architecture, the code current position (flash vs SRAM)
|
||||
|
// So, instead of wild guessing and making mistake, instead
|
||||
|
// compute it once for all
|
||||
|
ASM_CYCLES_PER_ITERATION = 1; |
||||
|
// We need to fetch some reference clock before waiting
|
||||
|
cli(); |
||||
|
uint32_t start = micros(); |
||||
|
delay_asm(1000); // On a typical CPU running in MHz, waiting 1000 "unknown cycles" means it'll take between 1ms to 6ms, that's perfectly acceptable
|
||||
|
uint32_t end = micros(); |
||||
|
sei(); |
||||
|
uint32_t expectedCycles = (end - start) * ((F_CPU) / 1000000UL); // Convert microseconds to cycles
|
||||
|
// Finally compute the right scale
|
||||
|
ASM_CYCLES_PER_ITERATION = (uint32_t)(expectedCycles / 1000); |
||||
|
|
||||
|
// No DWT present, likely a Cortex M0 so NOP counting is our best bet here
|
||||
|
DelayCycleFnc = delay_asm; |
||||
|
} |
||||
|
else { |
||||
|
// Enable DWT counter
|
||||
|
// From https://stackoverflow.com/a/41188674/1469714
|
||||
|
HW_REG(_DEM_CR) = HW_REG(_DEM_CR) | 0x01000000; // Enable trace
|
||||
|
#if __CORTEX_M == 7 |
||||
|
HW_REG(_LAR) = 0xC5ACCE55; // Unlock access to DWT registers, see https://developer.arm.com/documentation/ihi0029/e/ section B2.3.10
|
||||
|
#endif |
||||
|
HW_REG(_DWT_CYCCNT) = 0; // Clear DWT cycle counter
|
||||
|
HW_REG(_DWT_CTRL) = HW_REG(_DWT_CTRL) | 1; // Enable DWT cycle counter
|
||||
|
|
||||
|
// Then calibrate the constant offset from the counter
|
||||
|
ASM_CYCLES_PER_ITERATION = 0; |
||||
|
uint32_t s = HW_REG(_DWT_CYCCNT); |
||||
|
uint32_t e = HW_REG(_DWT_CYCCNT); // (e - s) contains the number of cycle required to read the cycle counter
|
||||
|
delay_dwt(0); |
||||
|
uint32_t f = HW_REG(_DWT_CYCCNT); // (f - e) contains the delay to call the delay function + the time to read the cycle counter
|
||||
|
ASM_CYCLES_PER_ITERATION = (f - e) - (e - s); |
||||
|
|
||||
|
// Use safer DWT function
|
||||
|
DelayCycleFnc = delay_dwt; |
||||
|
} |
||||
|
} |
||||
|
|
||||
|
#if ENABLED(MARLIN_DEV_MODE) |
||||
|
void dump_delay_accuracy_check() |
||||
|
{ |
||||
|
auto report_call_time = [](PGM_P const name, const uint32_t cycles, const uint32_t total, const bool do_flush=true) { |
||||
|
SERIAL_ECHOPGM("Calling "); |
||||
|
serialprintPGM(name); |
||||
|
SERIAL_ECHOLNPAIR(" for ", cycles, "cycles took: ", total, "cycles"); |
||||
|
if (do_flush) SERIAL_FLUSH(); |
||||
|
}; |
||||
|
|
||||
|
uint32_t s, e; |
||||
|
|
||||
|
SERIAL_ECHOLNPAIR("Computed delay calibration value: ", ASM_CYCLES_PER_ITERATION); |
||||
|
SERIAL_FLUSH(); |
||||
|
// Display the results of the calibration above
|
||||
|
constexpr uint32_t testValues[] = { 1, 5, 10, 20, 50, 100, 150, 200, 350, 500, 750, 1000 }; |
||||
|
for (auto i : testValues) { |
||||
|
s = micros(); DELAY_US(i); e = micros(); |
||||
|
report_call_time(PSTR("delay"), i, e - s); |
||||
|
} |
||||
|
|
||||
|
if (HW_REG(_DWT_CTRL)) { |
||||
|
for (auto i : testValues) { |
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(i); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(PSTR("delay"), i, e - s); |
||||
|
} |
||||
|
|
||||
|
// Measure the delay to call a real function compared to a function pointer
|
||||
|
s = HW_REG(_DWT_CYCCNT); delay_dwt(1); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(PSTR("delay_dwt"), 1, e - s); |
||||
|
|
||||
|
static PGMSTR(dcd, "DELAY_CYCLES directly "); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES( 1); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 1, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES( 5); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 5, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(10); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 10, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(20); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 20, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(50); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 50, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(100); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 100, e - s, false); |
||||
|
|
||||
|
s = HW_REG(_DWT_CYCCNT); DELAY_CYCLES(200); e = HW_REG(_DWT_CYCCNT); |
||||
|
report_call_time(dcd, 200, e - s, false); |
||||
|
} |
||||
|
} |
||||
|
#endif // MARLIN_DEV_MODE
|
||||
|
|
||||
|
|
||||
|
#else |
||||
|
|
||||
|
void calibrate_delay_loop() {} |
||||
|
#if ENABLED(MARLIN_DEV_MODE) |
||||
|
void dump_delay_accuracy_check() { |
||||
|
static PGMSTR(none, "N/A on this platform"); |
||||
|
serialprintPGM(none); |
||||
|
} |
||||
|
#endif |
||||
|
|
||||
|
#endif |
||||
Loading…
Reference in new issue