rusefi
/
libfirmware
mirror of https://github.com/rusefi/libfirmware.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

extracting method

This commit is contained in:
rusefi 2023-06-12 14:43:10 -04:00
parent 45ccd8e83e
commit 60018dd841
2 changed files with 9 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
pt2001/include/rusefi/pt2001.h
View File

@ -71,6 +71,7 @@ private:
// Chip IO helpers
uint16_t readDram(MC33816Mem addr);
void writeDram(MC33816Mem addr, uint16_t data);
uint16_t readStatus(int reg);
uint16_t readDriverStatus();
uint16_t readDriverStatus2();
void clearDriverStatus();

17
pt2001/src/pt2001.cpp
View File

@ -185,23 +185,21 @@ void Pt2001Base::clearDriverStatus(){
deselect();
}
uint16_t Pt2001Base::readDriverStatus() {
uint16_t Pt2001Base::readStatus(int reg) {
setupSpi(); // ensure on common page?
select();
send((0x8000 | 0x1D2 << 5) + 1);
send((0x8000 | reg << 5) + 1);
uint16_t driverStatus = recv();
deselect();
return driverStatus;
}
uint16_t Pt2001Base::readDriverStatus() {
return readStatus(0x1D2);
}
uint16_t Pt2001Base::readDriverStatus2() {
// todo: shame on me extract method!
setupSpi(); // ensure on common page?
select();
send((0x8000 | 0x1A5 << 5) + 1);
uint16_t driverStatus = recv();
deselect();
return driverStatus;
return readStatus(0x1A5);
}
static bool checkUndervoltVccP(uint16_t driverStatus){
@ -490,6 +488,7 @@ bool Pt2001Base::restart() {
}
status = readDriverStatus();
status2 = readDriverStatus2();
if (checkUndervoltVccP(status)) {
onError(McFault::UnderVoltage7);
shutdown();