FOME-Tech
/
fome-fw
mirror of https://github.com/FOME-Tech/fome-fw.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

mc33 flash check (#1296) 

Co-authored-by: Christopher W. Anderson <gitstuff@pswitch.com>
This commit is contained in:
NOx-z 2020-04-13 21:57:19 -07:00 committed by GitHub
parent ae0cc21ca3
commit 13111f6aa2
1 changed files with 32 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
firmware/hw_layer/mc33816.cpp
View File

@ -111,6 +111,30 @@ static void setup_spi() {
spiUnselect(driver);
}
static bool check_flash() {
spiSelect(driver);
// ch1
// read (MSB=1) at location, and 1 word
spi_writew((0x8000 | 0x100 << 5) + 1);
if (!(recv_16bit_spi() & (1<<5))) {
spiUnselect(driver);
return false;
}
// ch2
// read (MSB=1) at location, and 1 word
spi_writew((0x8000 | 0x120 << 5) + 1);
if (!(recv_16bit_spi() & (1<<5))) {
spiUnselect(driver);
return false;
}
spiUnselect(driver);
return true;
}
static void enable_flash() {
spiSelect(driver);
spi_writew(0x2001); //ch1
@ -343,6 +367,7 @@ void initMc33816(Logging *sharedLogger) {
flag0after = efiReadPin(CONFIG(mc33816_flag0));
if (flag0before || !flag0after) {
firmwareError(OBD_PCM_Processor_Fault, "MC33 no buena");
return;
}
}
@ -350,7 +375,14 @@ void initMc33816(Logging *sharedLogger) {
download_register(REG_CH2); // download channel 2 register configurations
download_register(REG_IO); // download IO register configurations
download_register(REG_DIAG); // download diag register configuration
// Finished downloading, let's run the code
enable_flash();
if(!check_flash())
{
firmwareError(OBD_PCM_Processor_Fault, "MC33 no flash");
return;
}
driven.setValue(1); // driven = HV
}