mirror of
https://github.com/g4klx/MMDVMHost
synced 2025-12-21 06:55:52 +08:00
Fix setFrequency() length for DVMega
This commit is contained in:
18
Modem.cpp
18
Modem.cpp
@@ -1044,10 +1044,18 @@ bool CModem::setConfig()
|
|||||||
bool CModem::setFrequency()
|
bool CModem::setFrequency()
|
||||||
{
|
{
|
||||||
unsigned char buffer[16U];
|
unsigned char buffer[16U];
|
||||||
|
unsigned char len;
|
||||||
|
|
||||||
|
if (m_hwType == HWT_DVMEGA)
|
||||||
|
len = 12U;
|
||||||
|
else {
|
||||||
|
buffer[12U] = (unsigned char)(m_rfLevel * 2.55F + 0.5F);
|
||||||
|
len = 13U;
|
||||||
|
}
|
||||||
|
|
||||||
buffer[0U] = MMDVM_FRAME_START;
|
buffer[0U] = MMDVM_FRAME_START;
|
||||||
|
|
||||||
buffer[1U] = 13U;
|
buffer[1U] = len;
|
||||||
|
|
||||||
buffer[2U] = MMDVM_SET_FREQ;
|
buffer[2U] = MMDVM_SET_FREQ;
|
||||||
|
|
||||||
@@ -1062,13 +1070,11 @@ bool CModem::setFrequency()
|
|||||||
buffer[9U] = (m_txFrequency >> 8) & 0xFFU;
|
buffer[9U] = (m_txFrequency >> 8) & 0xFFU;
|
||||||
buffer[10U] = (m_txFrequency >> 16) & 0xFFU;
|
buffer[10U] = (m_txFrequency >> 16) & 0xFFU;
|
||||||
buffer[11U] = (m_txFrequency >> 24) & 0xFFU;
|
buffer[11U] = (m_txFrequency >> 24) & 0xFFU;
|
||||||
|
|
||||||
buffer[12U] = (unsigned char)(m_rfLevel * 2.55F + 0.5F);
|
|
||||||
|
|
||||||
// CUtils::dump(1U, "Written", buffer, 13U);
|
// CUtils::dump(1U, "Written", buffer, len);
|
||||||
|
|
||||||
int ret = m_serial.write(buffer, 13U);
|
int ret = m_serial.write(buffer, len);
|
||||||
if (ret != 13)
|
if (ret != len)
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
unsigned int count = 0U;
|
unsigned int count = 0U;
|
||||||
|
|||||||
Reference in New Issue
Block a user