1 files changed, 173 insertions, 0 deletions
diff --git a/McuSt10f168/McuSt10f168.cpp b/McuSt10f168/McuSt10f168.cpp
new file mode 100755
index 0000000..6d60a21
--- /dev/null
+++ b/McuSt10f168/McuSt10f168.cpp
@@ -0,0 +1,173 @@
+#include "Logger.hpp"
+#include "ExitCodes.hpp"
+#include "McuSt10f168.hpp"
+#include "fw_st10f168.hpp"
+
+#include <sstream>
+
+using FwSt10f168::fw_st10f168;
+using FwSt10f168::fw_st10f168_length;
+
+#define ST10F168_FLASH_SIZE (256 * 1024)
+#define ST10F168_IDMANUF 0x0400
+#define ST10F168_IDCHIP 0x0A80
+#define ST10F168_ERASE_TIMEOUT 15000 // Ms
+#define ST10F168_MIN_PERIOD 30  // ns
+#define ST10F168_MAX_PERIOD 199 // ns
+#define ST10F168_MAX_FREQ   25  // MHz
+
+using std::ostringstream;
+
+bool
+CMcuSt10f168::hasThisId(uint16_t idmanuf, uint16_t idchip)
+{
+    // Mask out revision bits 3 - 0 from idchip value
+    return ((idmanuf == ST10F168_IDMANUF)
+            && ((idchip & 0xfff0) == ST10F168_IDCHIP));
+}
+
+CMcuSt10f168::CMcuSt10f168()
+{
+    mBlockSizes.push_back(16);
+    mBlockSizes.push_back(48);
+    mBlockSizes.push_back(96);
+    mBlockSizes.push_back(96);
+}
+
+CMcuSt10f168::~CMcuSt10f168()
+{
+    ;
+}
+
+string
+CMcuSt10f168::getName()
+{
+    return string("ST10F168");
+}
+
+uint8_t *
+CMcuSt10f168::getFirmware()
+{
+    return fw_st10f168;
+}
+
+int
+CMcuSt10f168::getFirmwareLength()
+{
+    return fw_st10f168_length;
+}
+
+const list<uint32_t>
+CMcuSt10f168::getBlockSizes()
+{
+    return mBlockSizes;
+}
+
+uint32_t
+CMcuSt10f168::getFlashSize()
+{
+    return ST10F168_FLASH_SIZE; 
+}
+
+int
+CMcuSt10f168::getEraseTimeout()
+{
+    return ST10F168_ERASE_TIMEOUT; 
+}
+
+string
+CMcuSt10f168::getMessageForRetCode(uint16_t ret)
+{
+    string s;
+
+    switch (ret) {
+    case 0x00: 
+        s = "Operation was successful";
+        break;
+    case 0x01: 
+        s = "Flash Protection is active";
+        break;
+    case 0x02: 
+        s = "Vpp voltage not present";
+        break;
+    case 0x03: 
+        s = "Programming operation failed";
+        break;
+    case 0x04: 
+        s = "Address value (R1) incorrect; not in Flash address area or odd";
+        break;
+    case 0x05: 
+        s = "CPU period out of range (must be between 30 ns and 199 ns)";
+        break;
+    case 0x06:
+        s = "Not enough free space on system stack for proper operation";
+        break;
+    case 0x07: 
+        s = "Incorrect bank number (R2,R3) specified";
+        break;
+    case 0x08: 
+        s = "Erase operation failed (phase 1)";
+        break;
+    case 0x09: 
+        s = "Bad source address for Multiple Word programming command";
+        break;
+    case 0x0A: 
+        s = "Bad number of words to be copied in Multiple Word programming command; one destination will be out of FLASH";
+        break;
+    case 0x0B: 
+        s = "PLL Unlocked or Oscilator watchdog overflow occured during programming or erasing the FLASH";
+        break;
+    case 0x0C: 
+        s = "Erase operation failed (phase 2)";
+        break;
+    case 0x0D: 
+        s = "MCU serial buffer overrun, use lower serial speed";
+        break;
+    case 0xFF: 
+        s = "Unknown or bad command";
+        break;
+    default: 
+        s = "";
+        break;
+    }
+
+    return s;
+}
+
+const list<uint16_t>
+CMcuSt10f168::getConfigData(float mcuFrequency)
+{
+    list<uint16_t> ret;
+    ret.push_back(get2TclConst(mcuFrequency));
+    return ret;
+}
+
+uint16_t
+CMcuSt10f168::get2TclConst(float mcuFrequency)
+{
+    if (mcuFrequency > ST10F168_MAX_FREQ) {
+        ostringstream os;
+        os << "User-entered CPU frequency " << mcuFrequency << " MHz is outside range ";
+        os << "(0, " << ST10F168_MAX_FREQ << "]";
+        CLogger::error(os.str(), EXIT_MCU);
+    }
+    uint16_t t = ((uint16_t) (1000.0 / mcuFrequency)) + 1;
+    if (t > 200) {
+        ostringstream os;
+        os << "For user-entered CPU frequency " << mcuFrequency << "MHz";
+        os << " the period is " << t << " ns which is greater than maximal allowed ";
+        os << "period " << ST10F168_MAX_PERIOD << " ns. Setting period to ";
+        os << ST10F168_MAX_PERIOD << " ns";
+        CLogger::warning(os.str());
+        t = ST10F168_MAX_PERIOD;
+    } else if (t < 30) {
+        ostringstream os;
+        os << "For user-entered CPU frequency " << mcuFrequency << "MHz";
+        os << " the period is " << t << " ns which is lower than minmal allowed ";
+        os << "period " << ST10F168_MIN_PERIOD << " ns. Setting period to ";
+        os << ST10F168_MIN_PERIOD << " ns";
+        CLogger::warning(os.str());
+        t = ST10F168_MIN_PERIOD;
+    }
+    return t;
+}