Add an error display.

Defines.h

@@ -24,6 +24,7 @@ const unsigned char MODE_DSTAR   = 1U;
 const unsigned char MODE_DMR     = 2U;
 const unsigned char MODE_YSF     = 3U;
 const unsigned char MODE_LOCKOUT = 99U;
+const unsigned char MODE_ERROR   = 100U;
 
 const unsigned char TAG_HEADER = 0x00U;
 const unsigned char TAG_DATA   = 0x01U;

Display.h

@@ -31,6 +31,7 @@ public:
   virtual void setIdle() = 0;
 
   virtual void setLockout() = 0;
+  virtual void setError(const char* text) = 0;
 
   virtual void setDStar() = 0;
   virtual void writeDStar(const char* my1, const char* my2, const char* your) = 0;

HD44780.cpp

@@ -68,6 +68,19 @@ void CHD44780::setIdle()
 	::lcdPuts(m_fd, "Idle");
 }
 
+void CHD44780::setError(const char* text)
+{
+	assert(text != NULL);
+
+	::lcdClear(m_fd);
+
+	::lcdPosition(m_fd, 0, 0);
+	::lcdPuts(m_fd, "MMDVM");
+
+	::lcdPosition(m_fd, 0, 1);
+	::lcdPrintf(m_fd, "%s ERROR", text);
+}
+
 void CHD44780::setLockout()
 {
 	::lcdClear(m_fd);

HD44780.h

@@ -33,6 +33,7 @@ public:
 
   virtual void setIdle();
 
+  virtual void setError(const char* text);
   virtual void setLockout();
 
   virtual void setDStar();

MMDVMHost.cpp

@@ -192,6 +192,12 @@ int CMMDVMHost::run()
 		else if (!lockout && m_mode == MODE_LOCKOUT)
 			setMode(MODE_IDLE);
 
+		bool error = m_modem->hasError();
+		if (error && m_mode != MODE_ERROR)
+			setMode(MODE_ERROR);
+		else if (!error && m_mode == MODE_ERROR)
+			setMode(MODE_IDLE);
+
 		unsigned char data[200U];
 		unsigned int len;
 		bool ret;
@@ -632,6 +638,18 @@ void CMMDVMHost::setMode(unsigned char mode, bool logging)
 		m_modeTimer.stop();
 		break;
 
+	case MODE_ERROR:
+		if (logging)
+			LogMessage("Mode set to Error");
+		if (m_dstarNetwork != NULL)
+			m_dstarNetwork->enable(false);
+		if (m_dmrNetwork != NULL)
+			m_dmrNetwork->enable(false);
+		m_display->setError("MODEM");
+		m_mode = MODE_ERROR;
+		m_modeTimer.stop();
+		break;
+
 	default:
 		if (logging)
 			LogMessage("Mode set to Idle");

Modem.cpp

@@ -108,7 +108,8 @@ m_dmrSpace1(0U),
 m_dmrSpace2(0U),
 m_ysfSpace(0U),
 m_tx(false),
-m_lockout(false)
+m_lockout(false),
+m_error(false)
 {
 	assert(!port.empty());
 
@@ -169,6 +170,7 @@ bool CModem::open()
 	m_statusTimer.start();
 	m_inactivityTimer.start();
 
+	m_error  = false;
 	m_offset = 0U;
 
 	return true;
@@ -186,6 +188,7 @@ void CModem::clock(unsigned int ms)
 	m_inactivityTimer.clock(ms);
 	if (m_inactivityTimer.hasExpired()) {
 		LogError("No reply from the modem for some time, resetting it");
+		m_error = true;
 		close();
 #if defined(_WIN32) || defined(_WIN64)
 		::Sleep(2000UL);		// 2s
@@ -643,6 +646,11 @@ bool CModem::hasLockout() const
 	return m_lockout;
 }
 
+bool CModem::hasError() const
+{
+	return m_error;
+}
+
 bool CModem::writeYSFData(const unsigned char* data, unsigned int length)
 {
 	assert(data != NULL);

Modem.h

@@ -53,6 +53,7 @@ public:
 	bool hasYSFSpace() const;
 
 	bool hasLockout() const;
+	bool hasError() const;
 
 	bool writeDStarData(const unsigned char* data, unsigned int length);
 	bool writeDMRData1(const unsigned char* data, unsigned int length);
@@ -105,6 +106,7 @@ private:
 	unsigned int               m_ysfSpace;
 	bool                       m_tx;
 	bool                       m_lockout;
+	bool                       m_error;
 
 	bool readVersion();
 	bool readStatus();

NullDisplay.cpp

@@ -35,6 +35,10 @@ void CNullDisplay::setIdle()
 {
 }
 
+void CNullDisplay::setError(const char* text)
+{
+}
+
 void CNullDisplay::setLockout()
 {
 }

NullDisplay.h

@@ -33,6 +33,7 @@ public:
 
   virtual void setIdle();
 
+  virtual void setError(const char* text);
   virtual void setLockout();
 
   virtual void setDStar();

TFTSerial.cpp

@@ -67,10 +67,8 @@ bool CTFTSerial::open()
 
 	setBrightness(m_brightness);
 
-	// Set background white
 	setBackground(COLOUR_WHITE);
 
-	// Set foreground black
 	setForeground(COLOUR_BLACK);
 
 	setIdle();
@@ -92,6 +90,29 @@ void CTFTSerial::setIdle()
 	displayText("IDLE");
 }
 
+void CTFTSerial::setError(const char* text)
+{
+	assert(text != NULL);
+
+	// Clear the screen
+	clearScreen();
+
+	setFontSize(FONT_MEDIUM);
+
+	// Draw MMDVM logo
+	displayBitmap(0U, 0U, "MMDVM_sm.bmp");
+
+	setForeground(COLOUR_RED);
+
+	gotoPosPixel(18U, 55U);
+	displayText(text);
+
+	gotoPosPixel(18U, 90U);
+	displayText("ERROR");
+
+	setForeground(COLOUR_BLACK);
+}
+
 void CTFTSerial::setLockout()
 {
 	// Clear the screen

TFTSerial.h

@@ -34,6 +34,7 @@ public:
 
   virtual void setIdle();
 
+  virtual void setError(const char* text);
   virtual void setLockout();
 
   virtual void setDStar();