core: make the full 4096 bytes of EEPROM work on Teensy 3.6 (#12947)
This commit updates QMK’s copy of the the teensy3 Arduino core code with the necessary changes to make the Teensy 3.6 work. Aside from different values for the partitioning, HSRUN mode must be left temporarily while using the EEPROM. fixes https://github.com/kinx-project/kint/issues/8 related to https://github.com/kinx-project/kint/issues/10
This commit is contained in:
parent
92385e30cd
commit
7f8faa429e
|
@ -39,7 +39,126 @@
|
||||||
* SOFTWARE.
|
* SOFTWARE.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#if defined(K20x) /* chip selection */
|
#define SMC_PMSTAT_RUN ((uint8_t)0x01)
|
||||||
|
#define SMC_PMSTAT_HSRUN ((uint8_t)0x80)
|
||||||
|
|
||||||
|
#define F_CPU KINETIS_SYSCLK_FREQUENCY
|
||||||
|
|
||||||
|
static int kinetis_hsrun_disable(void) {
|
||||||
|
#if defined(MK66F18)
|
||||||
|
if (SMC->PMSTAT == SMC_PMSTAT_HSRUN) {
|
||||||
|
// First, reduce the CPU clock speed, but do not change
|
||||||
|
// the peripheral speed (F_BUS). Serial1 & Serial2 baud
|
||||||
|
// rates will be impacted, but most other peripherals
|
||||||
|
// will continue functioning at the same speed.
|
||||||
|
# if F_CPU == 256000000 && F_BUS == 64000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 3, 1, 7); // TODO: TEST
|
||||||
|
# elif F_CPU == 256000000 && F_BUS == 128000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 7); // TODO: TEST
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 60000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 3, 1, 7); // ok
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 80000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 8); // ok
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 120000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 7); // ok
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 54000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 3, 1, 7); // ok
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 72000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 8); // ok
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 108000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 7); // ok
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 48000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 3, 1, 7); // ok
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 64000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 8); // ok
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 96000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 7); // ok
|
||||||
|
# elif F_CPU == 180000000 && F_BUS == 60000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 8); // ok
|
||||||
|
# elif F_CPU == 180000000 && F_BUS == 90000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 7); // ok
|
||||||
|
# elif F_CPU == 168000000 && F_BUS == 56000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 5); // ok
|
||||||
|
# elif F_CPU == 144000000 && F_BUS == 48000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(2, 2, 2, 5); // ok
|
||||||
|
# elif F_CPU == 144000000 && F_BUS == 72000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(1, 1, 1, 5); // ok
|
||||||
|
# elif F_CPU == 120000000 && F_BUS == 60000000
|
||||||
|
SIM->CLKDIV1 = SIM_CLKDIV1_OUTDIV1(KINETIS_CLKDIV1_OUTDIV1 - 1) | SIM_CLKDIV1_OUTDIV2(KINETIS_CLKDIV1_OUTDIV2 - 1) |
|
||||||
|
# if defined(MK66F18)
|
||||||
|
SIM_CLKDIV1_OUTDIV3(KINETIS_CLKDIV1_OUTDIV3 - 1) |
|
||||||
|
# endif
|
||||||
|
SIM_CLKDIV1_OUTDIV4(KINETIS_CLKDIV1_OUTDIV4 - 1);
|
||||||
|
# else
|
||||||
|
return 0;
|
||||||
|
# endif
|
||||||
|
// Then turn off HSRUN mode
|
||||||
|
SMC->PMCTRL = SMC_PMCTRL_RUNM_SET(0);
|
||||||
|
while (SMC->PMSTAT == SMC_PMSTAT_HSRUN)
|
||||||
|
; // wait
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int kinetis_hsrun_enable(void) {
|
||||||
|
#if defined(MK66F18)
|
||||||
|
if (SMC->PMSTAT == SMC_PMSTAT_RUN) {
|
||||||
|
// Turn HSRUN mode on
|
||||||
|
SMC->PMCTRL = SMC_PMCTRL_RUNM_SET(3);
|
||||||
|
while (SMC->PMSTAT != SMC_PMSTAT_HSRUN) {
|
||||||
|
;
|
||||||
|
} // wait
|
||||||
|
// Then configure clock for full speed
|
||||||
|
# if F_CPU == 256000000 && F_BUS == 64000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 3, 0, 7);
|
||||||
|
# elif F_CPU == 256000000 && F_BUS == 128000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 7);
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 60000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 3, 0, 7);
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 80000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 7);
|
||||||
|
# elif F_CPU == 240000000 && F_BUS == 120000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 7);
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 54000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 3, 0, 7);
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 72000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 7);
|
||||||
|
# elif F_CPU == 216000000 && F_BUS == 108000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 7);
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 48000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 3, 0, 6);
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 64000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 6);
|
||||||
|
# elif F_CPU == 192000000 && F_BUS == 96000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 6);
|
||||||
|
# elif F_CPU == 180000000 && F_BUS == 60000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 6);
|
||||||
|
# elif F_CPU == 180000000 && F_BUS == 90000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 6);
|
||||||
|
# elif F_CPU == 168000000 && F_BUS == 56000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 5);
|
||||||
|
# elif F_CPU == 144000000 && F_BUS == 48000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 2, 0, 4);
|
||||||
|
# elif F_CPU == 144000000 && F_BUS == 72000000
|
||||||
|
SIM_CLKDIV1 = SIM_CLKDIV1_OUTDIVS(0, 1, 0, 4);
|
||||||
|
# elif F_CPU == 120000000 && F_BUS == 60000000
|
||||||
|
SIM->CLKDIV1 = SIM_CLKDIV1_OUTDIV1(KINETIS_CLKDIV1_OUTDIV1 - 1) | SIM_CLKDIV1_OUTDIV2(KINETIS_CLKDIV1_OUTDIV2 - 1) |
|
||||||
|
# if defined(MK66F18)
|
||||||
|
SIM_CLKDIV1_OUTDIV3(KINETIS_CLKDIV1_OUTDIV3 - 1) |
|
||||||
|
# endif
|
||||||
|
SIM_CLKDIV1_OUTDIV4(KINETIS_CLKDIV1_OUTDIV4 - 1);
|
||||||
|
# else
|
||||||
|
return 0;
|
||||||
|
# endif
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
#if defined(K20x) || defined(MK66F18) /* chip selection */
|
||||||
/* Teensy 3.0, 3.1, 3.2; mchck; infinity keyboard */
|
/* Teensy 3.0, 3.1, 3.2; mchck; infinity keyboard */
|
||||||
|
|
||||||
// The EEPROM is really RAM with a hardware-based backup system to
|
// The EEPROM is really RAM with a hardware-based backup system to
|
||||||
|
@ -69,22 +188,34 @@
|
||||||
//
|
//
|
||||||
# define HANDLE_UNALIGNED_WRITES
|
# define HANDLE_UNALIGNED_WRITES
|
||||||
|
|
||||||
|
# if defined(K20x)
|
||||||
|
# define EEPROM_MAX 2048
|
||||||
|
# define EEPARTITION 0x03 // all 32K dataflash for EEPROM, none for Data
|
||||||
|
# define EEESPLIT 0x30 // must be 0x30 on these chips
|
||||||
|
# elif defined(MK66F18)
|
||||||
|
# define EEPROM_MAX 4096
|
||||||
|
# define EEPARTITION 0x05 // 128K dataflash for EEPROM, 128K for Data
|
||||||
|
# define EEESPLIT 0x10 // best endurance: 0x00 = first 12%, 0x10 = first 25%, 0x30 = all equal
|
||||||
|
# endif
|
||||||
|
|
||||||
// Minimum EEPROM Endurance
|
// Minimum EEPROM Endurance
|
||||||
// ------------------------
|
// ------------------------
|
||||||
# if (EEPROM_SIZE == 2048) // 35000 writes/byte or 70000 writes/word
|
# if (EEPROM_SIZE == 4096)
|
||||||
# define EEESIZE 0x33
|
# define EEESIZE 0x02
|
||||||
|
# elif (EEPROM_SIZE == 2048) // 35000 writes/byte or 70000 writes/word
|
||||||
|
# define EEESIZE 0x03
|
||||||
# elif (EEPROM_SIZE == 1024) // 75000 writes/byte or 150000 writes/word
|
# elif (EEPROM_SIZE == 1024) // 75000 writes/byte or 150000 writes/word
|
||||||
# define EEESIZE 0x34
|
# define EEESIZE 0x04
|
||||||
# elif (EEPROM_SIZE == 512) // 155000 writes/byte or 310000 writes/word
|
# elif (EEPROM_SIZE == 512) // 155000 writes/byte or 310000 writes/word
|
||||||
# define EEESIZE 0x35
|
# define EEESIZE 0x05
|
||||||
# elif (EEPROM_SIZE == 256) // 315000 writes/byte or 630000 writes/word
|
# elif (EEPROM_SIZE == 256) // 315000 writes/byte or 630000 writes/word
|
||||||
# define EEESIZE 0x36
|
# define EEESIZE 0x06
|
||||||
# elif (EEPROM_SIZE == 128) // 635000 writes/byte or 1270000 writes/word
|
# elif (EEPROM_SIZE == 128) // 635000 writes/byte or 1270000 writes/word
|
||||||
# define EEESIZE 0x37
|
# define EEESIZE 0x07
|
||||||
# elif (EEPROM_SIZE == 64) // 1275000 writes/byte or 2550000 writes/word
|
# elif (EEPROM_SIZE == 64) // 1275000 writes/byte or 2550000 writes/word
|
||||||
# define EEESIZE 0x38
|
# define EEESIZE 0x08
|
||||||
# elif (EEPROM_SIZE == 32) // 2555000 writes/byte or 5110000 writes/word
|
# elif (EEPROM_SIZE == 32) // 2555000 writes/byte or 5110000 writes/word
|
||||||
# define EEESIZE 0x39
|
# define EEESIZE 0x09
|
||||||
# endif
|
# endif
|
||||||
|
|
||||||
/** \brief eeprom initialization
|
/** \brief eeprom initialization
|
||||||
|
@ -97,15 +228,21 @@ void eeprom_initialize(void) {
|
||||||
uint8_t status;
|
uint8_t status;
|
||||||
|
|
||||||
if (FTFL->FCNFG & FTFL_FCNFG_RAMRDY) {
|
if (FTFL->FCNFG & FTFL_FCNFG_RAMRDY) {
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
|
|
||||||
// FlexRAM is configured as traditional RAM
|
// FlexRAM is configured as traditional RAM
|
||||||
// We need to reconfigure for EEPROM usage
|
// We need to reconfigure for EEPROM usage
|
||||||
FTFL->FCCOB0 = 0x80; // PGMPART = Program Partition Command
|
kinetis_hsrun_disable();
|
||||||
FTFL->FCCOB4 = EEESIZE; // EEPROM Size
|
FTFL->FCCOB0 = FTFE_FCCOB0_CCOBn_SET(0x80); // PGMPART = Program Partition Command
|
||||||
FTFL->FCCOB5 = 0x03; // 0K for Dataflash, 32K for EEPROM backup
|
FTFL->FCCOB3 = 0;
|
||||||
|
FTFL->FCCOB4 = EEESPLIT | EEESIZE;
|
||||||
|
FTFL->FCCOB5 = EEPARTITION;
|
||||||
__disable_irq();
|
__disable_irq();
|
||||||
// do_flash_cmd() must execute from RAM. Luckily the C syntax is simple...
|
// do_flash_cmd() must execute from RAM. Luckily the C syntax is simple...
|
||||||
(*((void (*)(volatile uint8_t *))((uint32_t)do_flash_cmd | 1)))(&(FTFL->FSTAT));
|
(*((void (*)(volatile uint8_t *))((uint32_t)do_flash_cmd | 1)))(&(FTFL->FSTAT));
|
||||||
__enable_irq();
|
__enable_irq();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
status = FTFL->FSTAT;
|
status = FTFL->FSTAT;
|
||||||
if (status & (FTFL_FSTAT_RDCOLERR | FTFL_FSTAT_ACCERR | FTFL_FSTAT_FPVIOL)) {
|
if (status & (FTFL_FSTAT_RDCOLERR | FTFL_FSTAT_ACCERR | FTFL_FSTAT_FPVIOL)) {
|
||||||
FTFL->FSTAT = (status & (FTFL_FSTAT_RDCOLERR | FTFL_FSTAT_ACCERR | FTFL_FSTAT_FPVIOL));
|
FTFL->FSTAT = (status & (FTFL_FSTAT_RDCOLERR | FTFL_FSTAT_ACCERR | FTFL_FSTAT_FPVIOL));
|
||||||
|
@ -114,11 +251,11 @@ void eeprom_initialize(void) {
|
||||||
}
|
}
|
||||||
// wait for eeprom to become ready (is this really necessary?)
|
// wait for eeprom to become ready (is this really necessary?)
|
||||||
while (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) {
|
while (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) {
|
||||||
if (++count > 20000) break;
|
if (++count > 200000) break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
# define FlexRAM ((uint8_t *)0x14000000)
|
# define FlexRAM ((volatile uint8_t *)0x14000000)
|
||||||
|
|
||||||
/** \brief eeprom read byte
|
/** \brief eeprom read byte
|
||||||
*
|
*
|
||||||
|
@ -195,8 +332,12 @@ void eeprom_write_byte(uint8_t *addr, uint8_t value) {
|
||||||
if (offset >= EEPROM_SIZE) return;
|
if (offset >= EEPROM_SIZE) return;
|
||||||
if (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) eeprom_initialize();
|
if (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) eeprom_initialize();
|
||||||
if (FlexRAM[offset] != value) {
|
if (FlexRAM[offset] != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset] = value;
|
FlexRAM[offset] = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -213,18 +354,30 @@ void eeprom_write_word(uint16_t *addr, uint16_t value) {
|
||||||
if ((offset & 1) == 0) {
|
if ((offset & 1) == 0) {
|
||||||
# endif
|
# endif
|
||||||
if (*(uint16_t *)(&FlexRAM[offset]) != value) {
|
if (*(uint16_t *)(&FlexRAM[offset]) != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint16_t *)(&FlexRAM[offset]) = value;
|
*(uint16_t *)(&FlexRAM[offset]) = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
# ifdef HANDLE_UNALIGNED_WRITES
|
# ifdef HANDLE_UNALIGNED_WRITES
|
||||||
} else {
|
} else {
|
||||||
if (FlexRAM[offset] != value) {
|
if (FlexRAM[offset] != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset] = value;
|
FlexRAM[offset] = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
if (FlexRAM[offset + 1] != (value >> 8)) {
|
if (FlexRAM[offset + 1] != (value >> 8)) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset + 1] = value >> 8;
|
FlexRAM[offset + 1] = value >> 8;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
# endif
|
# endif
|
||||||
|
@ -244,33 +397,57 @@ void eeprom_write_dword(uint32_t *addr, uint32_t value) {
|
||||||
case 0:
|
case 0:
|
||||||
# endif
|
# endif
|
||||||
if (*(uint32_t *)(&FlexRAM[offset]) != value) {
|
if (*(uint32_t *)(&FlexRAM[offset]) != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint32_t *)(&FlexRAM[offset]) = value;
|
*(uint32_t *)(&FlexRAM[offset]) = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
return;
|
return;
|
||||||
# ifdef HANDLE_UNALIGNED_WRITES
|
# ifdef HANDLE_UNALIGNED_WRITES
|
||||||
case 2:
|
case 2:
|
||||||
if (*(uint16_t *)(&FlexRAM[offset]) != value) {
|
if (*(uint16_t *)(&FlexRAM[offset]) != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint16_t *)(&FlexRAM[offset]) = value;
|
*(uint16_t *)(&FlexRAM[offset]) = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
if (*(uint16_t *)(&FlexRAM[offset + 2]) != (value >> 16)) {
|
if (*(uint16_t *)(&FlexRAM[offset + 2]) != (value >> 16)) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint16_t *)(&FlexRAM[offset + 2]) = value >> 16;
|
*(uint16_t *)(&FlexRAM[offset + 2]) = value >> 16;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
return;
|
return;
|
||||||
default:
|
default:
|
||||||
if (FlexRAM[offset] != value) {
|
if (FlexRAM[offset] != value) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset] = value;
|
FlexRAM[offset] = value;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
if (*(uint16_t *)(&FlexRAM[offset + 1]) != (value >> 8)) {
|
if (*(uint16_t *)(&FlexRAM[offset + 1]) != (value >> 8)) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint16_t *)(&FlexRAM[offset + 1]) = value >> 8;
|
*(uint16_t *)(&FlexRAM[offset + 1]) = value >> 8;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
if (FlexRAM[offset + 3] != (value >> 24)) {
|
if (FlexRAM[offset + 3] != (value >> 24)) {
|
||||||
|
kinetis_hsrun_disable();
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset + 3] = value >> 24;
|
FlexRAM[offset + 3] = value >> 24;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
# endif
|
# endif
|
||||||
|
@ -288,6 +465,7 @@ void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
|
||||||
if (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) eeprom_initialize();
|
if (!(FTFL->FCNFG & FTFL_FCNFG_EEERDY)) eeprom_initialize();
|
||||||
if (len >= EEPROM_SIZE) len = EEPROM_SIZE;
|
if (len >= EEPROM_SIZE) len = EEPROM_SIZE;
|
||||||
if (offset + len >= EEPROM_SIZE) len = EEPROM_SIZE - offset;
|
if (offset + len >= EEPROM_SIZE) len = EEPROM_SIZE - offset;
|
||||||
|
kinetis_hsrun_disable();
|
||||||
while (len > 0) {
|
while (len > 0) {
|
||||||
uint32_t lsb = offset & 3;
|
uint32_t lsb = offset & 3;
|
||||||
if (lsb == 0 && len >= 4) {
|
if (lsb == 0 && len >= 4) {
|
||||||
|
@ -298,6 +476,8 @@ void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
|
||||||
val32 |= (*src++ << 16);
|
val32 |= (*src++ << 16);
|
||||||
val32 |= (*src++ << 24);
|
val32 |= (*src++ << 24);
|
||||||
if (*(uint32_t *)(&FlexRAM[offset]) != val32) {
|
if (*(uint32_t *)(&FlexRAM[offset]) != val32) {
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint32_t *)(&FlexRAM[offset]) = val32;
|
*(uint32_t *)(&FlexRAM[offset]) = val32;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
}
|
}
|
||||||
|
@ -309,6 +489,8 @@ void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
|
||||||
val16 = *src++;
|
val16 = *src++;
|
||||||
val16 |= (*src++ << 8);
|
val16 |= (*src++ << 8);
|
||||||
if (*(uint16_t *)(&FlexRAM[offset]) != val16) {
|
if (*(uint16_t *)(&FlexRAM[offset]) != val16) {
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
*(uint16_t *)(&FlexRAM[offset]) = val16;
|
*(uint16_t *)(&FlexRAM[offset]) = val16;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
}
|
}
|
||||||
|
@ -318,6 +500,8 @@ void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
|
||||||
// write 8 bits
|
// write 8 bits
|
||||||
uint8_t val8 = *src++;
|
uint8_t val8 = *src++;
|
||||||
if (FlexRAM[offset] != val8) {
|
if (FlexRAM[offset] != val8) {
|
||||||
|
uint8_t stat = FTFL->FSTAT & 0x70;
|
||||||
|
if (stat) FTFL->FSTAT = stat;
|
||||||
FlexRAM[offset] = val8;
|
FlexRAM[offset] = val8;
|
||||||
flexram_wait();
|
flexram_wait();
|
||||||
}
|
}
|
||||||
|
@ -325,6 +509,7 @@ void eeprom_write_block(const void *buf, void *addr, uint32_t len) {
|
||||||
len--;
|
len--;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
kinetis_hsrun_enable();
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|
Loading…
Reference in New Issue