Merge upstream changes from Marlin 2.1.1
This commit is contained in:
@@ -33,6 +33,10 @@
|
||||
#include "timers.h"
|
||||
#include <Wire.h>
|
||||
|
||||
// ------------------------
|
||||
// Serial ports
|
||||
// ------------------------
|
||||
|
||||
#define _IMPLEMENT_SERIAL(X) DefaultSerial##X MSerial##X(false, Serial##X)
|
||||
#define IMPLEMENT_SERIAL(X) _IMPLEMENT_SERIAL(X)
|
||||
#if WITHIN(SERIAL_PORT, 0, 3)
|
||||
@@ -40,88 +44,153 @@
|
||||
#endif
|
||||
USBSerialType USBSerial(false, SerialUSB);
|
||||
|
||||
uint16_t HAL_adc_result, HAL_adc_select;
|
||||
// ------------------------
|
||||
// FastIO
|
||||
// ------------------------
|
||||
|
||||
static const uint8_t pin2sc1a[] = {
|
||||
0x07, // 0/A0 AD_B1_02
|
||||
0x08, // 1/A1 AD_B1_03
|
||||
0x0C, // 2/A2 AD_B1_07
|
||||
0x0B, // 3/A3 AD_B1_06
|
||||
0x06, // 4/A4 AD_B1_01
|
||||
0x05, // 5/A5 AD_B1_00
|
||||
0x0F, // 6/A6 AD_B1_10
|
||||
0x00, // 7/A7 AD_B1_11
|
||||
0x0D, // 8/A8 AD_B1_08
|
||||
0x0E, // 9/A9 AD_B1_09
|
||||
0x01, // 24/A10 AD_B0_12
|
||||
0x02, // 25/A11 AD_B0_13
|
||||
0x83, // 26/A12 AD_B1_14 - only on ADC2, 3
|
||||
0x84, // 27/A13 AD_B1_15 - only on ADC2, 4
|
||||
0x07, // 14/A0 AD_B1_02
|
||||
0x08, // 15/A1 AD_B1_03
|
||||
0x0C, // 16/A2 AD_B1_07
|
||||
0x0B, // 17/A3 AD_B1_06
|
||||
0x06, // 18/A4 AD_B1_01
|
||||
0x05, // 19/A5 AD_B1_00
|
||||
0x0F, // 20/A6 AD_B1_10
|
||||
0x00, // 21/A7 AD_B1_11
|
||||
0x0D, // 22/A8 AD_B1_08
|
||||
0x0E, // 23/A9 AD_B1_09
|
||||
0x01, // 24/A10 AD_B0_12
|
||||
0x02, // 25/A11 AD_B0_13
|
||||
0x83, // 26/A12 AD_B1_14 - only on ADC2, 3
|
||||
0x84, // 27/A13 AD_B1_15 - only on ADC2, 4
|
||||
#ifdef ARDUINO_TEENSY41
|
||||
0xFF, // 28
|
||||
0xFF, // 29
|
||||
0xFF, // 30
|
||||
0xFF, // 31
|
||||
0xFF, // 32
|
||||
0xFF, // 33
|
||||
0xFF, // 34
|
||||
0xFF, // 35
|
||||
0xFF, // 36
|
||||
0xFF, // 37
|
||||
0x81, // 38/A14 AD_B1_12 - only on ADC2, 1
|
||||
0x82, // 39/A15 AD_B1_13 - only on ADC2, 2
|
||||
0x09, // 40/A16 AD_B1_04
|
||||
0x0A, // 41/A17 AD_B1_05
|
||||
#endif
|
||||
};
|
||||
|
||||
/*
|
||||
// disable interrupts
|
||||
void cli() { noInterrupts(); }
|
||||
|
||||
// enable interrupts
|
||||
void sei() { interrupts(); }
|
||||
*/
|
||||
|
||||
void HAL_adc_init() {
|
||||
analog_init();
|
||||
while (ADC1_GC & ADC_GC_CAL) ;
|
||||
while (ADC2_GC & ADC_GC_CAL) ;
|
||||
bool is_output(pin_t pin) {
|
||||
const struct digital_pin_bitband_and_config_table_struct *p;
|
||||
p = digital_pin_to_info_PGM + pin;
|
||||
return (*(p->reg + 1) & p->mask);
|
||||
}
|
||||
|
||||
void HAL_clear_reset_source() {
|
||||
uint32_t reset_source = SRC_SRSR;
|
||||
SRC_SRSR = reset_source;
|
||||
}
|
||||
// ------------------------
|
||||
// MarlinHAL Class
|
||||
// ------------------------
|
||||
|
||||
uint8_t HAL_get_reset_source() {
|
||||
void MarlinHAL::reboot() { _reboot_Teensyduino_(); }
|
||||
|
||||
uint8_t MarlinHAL::get_reset_source() {
|
||||
switch (SRC_SRSR & 0xFF) {
|
||||
case 1: return RST_POWER_ON; break;
|
||||
case 2: return RST_SOFTWARE; break;
|
||||
case 4: return RST_EXTERNAL; break;
|
||||
// case 8: return RST_BROWN_OUT; break;
|
||||
//case 8: return RST_BROWN_OUT; break;
|
||||
case 16: return RST_WATCHDOG; break;
|
||||
case 64: return RST_JTAG; break;
|
||||
// case 128: return RST_OVERTEMP; break;
|
||||
case 64: return RST_JTAG; break;
|
||||
//case 128: return RST_OVERTEMP; break;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
void HAL_reboot() { _reboot_Teensyduino_(); }
|
||||
void MarlinHAL::clear_reset_source() {
|
||||
uint32_t reset_source = SRC_SRSR;
|
||||
SRC_SRSR = reset_source;
|
||||
}
|
||||
|
||||
// ------------------------
|
||||
// Watchdog Timer
|
||||
// ------------------------
|
||||
|
||||
#if ENABLED(USE_WATCHDOG)
|
||||
|
||||
#define WDT_TIMEOUT TERN(WATCHDOG_DURATION_8S, 8, 4) // 4 or 8 second timeout
|
||||
|
||||
constexpr uint8_t timeoutval = (WDT_TIMEOUT - 0.5f) / 0.5f;
|
||||
|
||||
void MarlinHAL::watchdog_init() {
|
||||
CCM_CCGR3 |= CCM_CCGR3_WDOG1(3); // enable WDOG1 clocks
|
||||
WDOG1_WMCR = 0; // disable power down PDE
|
||||
WDOG1_WCR |= WDOG_WCR_SRS | WDOG_WCR_WT(timeoutval);
|
||||
WDOG1_WCR |= WDOG_WCR_WDE | WDOG_WCR_WDT | WDOG_WCR_SRE;
|
||||
}
|
||||
|
||||
void MarlinHAL::watchdog_refresh() {
|
||||
// Watchdog refresh sequence
|
||||
WDOG1_WSR = 0x5555;
|
||||
WDOG1_WSR = 0xAAAA;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
// ------------------------
|
||||
// ADC
|
||||
// ------------------------
|
||||
|
||||
int8_t MarlinHAL::adc_select;
|
||||
|
||||
void MarlinHAL::adc_init() {
|
||||
analog_init();
|
||||
while (ADC1_GC & ADC_GC_CAL) { /* wait */ }
|
||||
while (ADC2_GC & ADC_GC_CAL) { /* wait */ }
|
||||
}
|
||||
|
||||
void MarlinHAL::adc_start(const pin_t adc_pin) {
|
||||
static const uint8_t pin2sc1a[] = {
|
||||
0x07, // 0/A0 AD_B1_02
|
||||
0x08, // 1/A1 AD_B1_03
|
||||
0x0C, // 2/A2 AD_B1_07
|
||||
0x0B, // 3/A3 AD_B1_06
|
||||
0x06, // 4/A4 AD_B1_01
|
||||
0x05, // 5/A5 AD_B1_00
|
||||
0x0F, // 6/A6 AD_B1_10
|
||||
0x00, // 7/A7 AD_B1_11
|
||||
0x0D, // 8/A8 AD_B1_08
|
||||
0x0E, // 9/A9 AD_B1_09
|
||||
0x01, // 24/A10 AD_B0_12
|
||||
0x02, // 25/A11 AD_B0_13
|
||||
0x83, // 26/A12 AD_B1_14 - only on ADC2, 3
|
||||
0x84, // 27/A13 AD_B1_15 - only on ADC2, 4
|
||||
0x07, // 14/A0 AD_B1_02
|
||||
0x08, // 15/A1 AD_B1_03
|
||||
0x0C, // 16/A2 AD_B1_07
|
||||
0x0B, // 17/A3 AD_B1_06
|
||||
0x06, // 18/A4 AD_B1_01
|
||||
0x05, // 19/A5 AD_B1_00
|
||||
0x0F, // 20/A6 AD_B1_10
|
||||
0x00, // 21/A7 AD_B1_11
|
||||
0x0D, // 22/A8 AD_B1_08
|
||||
0x0E, // 23/A9 AD_B1_09
|
||||
0x01, // 24/A10 AD_B0_12
|
||||
0x02, // 25/A11 AD_B0_13
|
||||
0x83, // 26/A12 AD_B1_14 - only on ADC2, 3
|
||||
0x84, // 27/A13 AD_B1_15 - only on ADC2, 4
|
||||
#ifdef ARDUINO_TEENSY41
|
||||
0xFF, // 28
|
||||
0xFF, // 29
|
||||
0xFF, // 30
|
||||
0xFF, // 31
|
||||
0xFF, // 32
|
||||
0xFF, // 33
|
||||
0xFF, // 34
|
||||
0xFF, // 35
|
||||
0xFF, // 36
|
||||
0xFF, // 37
|
||||
0x81, // 38/A14 AD_B1_12 - only on ADC2, 1
|
||||
0x82, // 39/A15 AD_B1_13 - only on ADC2, 2
|
||||
0x09, // 40/A16 AD_B1_04
|
||||
0x0A, // 41/A17 AD_B1_05
|
||||
#endif
|
||||
};
|
||||
const uint16_t pin = pin2sc1a[adc_pin];
|
||||
if (pin == 0xFF) {
|
||||
adc_select = -1; // Digital only
|
||||
}
|
||||
else if (pin & 0x80) {
|
||||
adc_select = 1;
|
||||
ADC2_HC0 = pin & 0x7F;
|
||||
}
|
||||
else {
|
||||
adc_select = 0;
|
||||
ADC1_HC0 = pin;
|
||||
}
|
||||
}
|
||||
|
||||
uint16_t MarlinHAL::adc_value() {
|
||||
switch (adc_select) {
|
||||
case 0:
|
||||
while (!(ADC1_HS & ADC_HS_COCO0)) { /* wait */ }
|
||||
return ADC1_R0;
|
||||
case 1:
|
||||
while (!(ADC2_HS & ADC_HS_COCO0)) { /* wait */ }
|
||||
return ADC2_R0;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
// ------------------------
|
||||
// Free Memory Accessor
|
||||
// ------------------------
|
||||
|
||||
#define __bss_end _ebss
|
||||
|
||||
@@ -133,45 +202,9 @@ extern "C" {
|
||||
// Doesn't work on Teensy 4.x
|
||||
uint32_t freeMemory() {
|
||||
uint32_t free_memory;
|
||||
if ((uint32_t)__brkval == 0)
|
||||
free_memory = ((uint32_t)&free_memory) - ((uint32_t)&__bss_end);
|
||||
else
|
||||
free_memory = ((uint32_t)&free_memory) - ((uint32_t)__brkval);
|
||||
free_memory = ((uint32_t)&free_memory) - (((uint32_t)__brkval) ?: ((uint32_t)&__bss_end));
|
||||
return free_memory;
|
||||
}
|
||||
}
|
||||
|
||||
void HAL_adc_start_conversion(const uint8_t adc_pin) {
|
||||
const uint16_t pin = pin2sc1a[adc_pin];
|
||||
if (pin == 0xFF) {
|
||||
HAL_adc_select = -1; // Digital only
|
||||
}
|
||||
else if (pin & 0x80) {
|
||||
HAL_adc_select = 1;
|
||||
ADC2_HC0 = pin & 0x7F;
|
||||
}
|
||||
else {
|
||||
HAL_adc_select = 0;
|
||||
ADC1_HC0 = pin;
|
||||
}
|
||||
}
|
||||
|
||||
uint16_t HAL_adc_get_result() {
|
||||
switch (HAL_adc_select) {
|
||||
case 0:
|
||||
while (!(ADC1_HS & ADC_HS_COCO0)) ; // wait
|
||||
return ADC1_R0;
|
||||
case 1:
|
||||
while (!(ADC2_HS & ADC_HS_COCO0)) ; // wait
|
||||
return ADC2_R0;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
bool is_output(uint8_t pin) {
|
||||
const struct digital_pin_bitband_and_config_table_struct *p;
|
||||
p = digital_pin_to_info_PGM + pin;
|
||||
return (*(p->reg + 1) & p->mask);
|
||||
}
|
||||
|
||||
#endif // __IMXRT1062__
|
||||
|
Reference in New Issue
Block a user