ua1zbe
/
MMDVMHost
mirror of https://github.com/g4klx/MMDVMHost
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

Improve the serial port parsing.

This commit is contained in:
Jonathan Naylor 2016-11-04 06:46:27 +00:00
parent 496078928c
commit 9238d74082
1 changed files with 24 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

48
UMP/UMP.ino
View File

@ -73,7 +73,7 @@ bool m_started = false;
uint32_t m_count = 0U; uint32_t m_count = 0U;
bool m_led = false; bool m_led = false;
uint8_t m_buffer[255U]; uint8_t m_buffer[256U];
uint8_t m_offset = 0U; uint8_t m_offset = 0U;
uint8_t m_length = 0U; uint8_t m_length = 0U;
@ -95,33 +95,33 @@ void loop()
} else { } else {
m_buffer[m_offset] = c; m_buffer[m_offset] = c;
m_offset++; m_offset++;
}
if (m_length == m_offset) { if (m_length == m_offset) {
switch (m_buffer[2U]) { switch (m_buffer[2U]) {
case UMP_HELLO: case UMP_HELLO:
m_started = true; m_started = true;
break; break;
case UMP_SET_MODE: case UMP_SET_MODE:
digitalWrite(PIN_DSTAR, m_buffer[3U] == MODE_DSTAR ? HIGH : LOW); digitalWrite(PIN_DSTAR, m_buffer[3U] == MODE_DSTAR ? HIGH : LOW);
digitalWrite(PIN_DMR, m_buffer[3U] == MODE_DMR ? HIGH : LOW); digitalWrite(PIN_DMR, m_buffer[3U] == MODE_DMR ? HIGH : LOW);
digitalWrite(PIN_YSF, m_buffer[3U] == MODE_YSF ? HIGH : LOW); digitalWrite(PIN_YSF, m_buffer[3U] == MODE_YSF ? HIGH : LOW);
digitalWrite(PIN_P25, m_buffer[3U] == MODE_P25 ? HIGH : LOW); digitalWrite(PIN_P25, m_buffer[3U] == MODE_P25 ? HIGH : LOW);
break; break;
case UMP_SET_TX: case UMP_SET_TX:
digitalWrite(PIN_TX, m_buffer[3U] == 0x01U ? HIGH : LOW); digitalWrite(PIN_TX, m_buffer[3U] == 0x01U ? HIGH : LOW);
break; break;
#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega32U4__) || defined(__SAM3X8E__) #if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega32U4__) || defined(__SAM3X8E__)
case UMP_WRITE_SERIAL: case UMP_WRITE_SERIAL:
Serial1.write(m_buffer + 3U, m_length - 3U); Serial1.write(m_buffer + 3U, m_length - 3U);
break; break;
#endif #endif
default: default:
break; break;
} }
m_length = 0U; m_length = 0U;
m_offset = 0U; m_offset = 0U;
}
} }
} }