diff --git a/pt2001/include/rusefi/pt2001.h b/pt2001/include/rusefi/pt2001.h index eb758d0..5ee8125 100644 --- a/pt2001/include/rusefi/pt2001.h +++ b/pt2001/include/rusefi/pt2001.h @@ -46,7 +46,12 @@ public: McFault fault = McFault::None; uint16_t status = 0; - uint16_t status2 = 0; + uint16_t status5 = 0; + uint16_t status6 = 0; + uint16_t status7 = 0; + uint16_t status8 = 0; + + uint16_t readStatus(int reg); private: // SPI tx/rx helpers @@ -61,7 +66,7 @@ private: // Chip init logic void setupSpi(); uint16_t readId(); - + void enableFlash(); bool checkFlash(); @@ -71,9 +76,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(); protected: diff --git a/pt2001/src/pt2001.cpp b/pt2001/src/pt2001.cpp index d859fc6..ebbc093 100644 --- a/pt2001/src/pt2001.cpp +++ b/pt2001/src/pt2001.cpp @@ -198,10 +198,6 @@ uint16_t Pt2001Base::readDriverStatus() { return readStatus(0x1D2); } -uint16_t Pt2001Base::readDriverStatus2() { - return readStatus(0x1A5); -} - static bool checkUndervoltVccP(uint16_t driverStatus){ return (driverStatus & (1<<0)); } @@ -488,7 +484,10 @@ bool Pt2001Base::restart() { } status = readDriverStatus(); - status2 = readDriverStatus2(); + status5 = readStatus(0x1A5); + status6 = readStatus(0x1A6); + status7 = readStatus(0x1A7); + status8 = readStatus(0x1A8); if (checkUndervoltVccP(status)) { onError(McFault::UnderVoltage7); shutdown();