iframe-proxy | Sunbelt Computer Software

Repository navigation

History

100

101

102

103

104

105

106

107

108

109

110

111

112

113

114

115

116

117

118

* This program is free software; you can redistribute it and/or modify

* it under the terms of the GNU General Public License as published by

* the Free Software Foundation; either version 2 of the License, or

* (at your option) any later version.

* This program is distributed in the hope that it will be useful,

* but WITHOUT ANY WARRANTY; without even the implied warranty of

* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

* GNU General Public License for more details.

* You should have received a copy of the GNU General Public License

* along with this program; if not, write to the Free Software

* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

#include "Config.h"

#include "Globals.h"

#include "YSFTX.h"

#include "YSFDefines.h"

const uint8_t YSF_START_SYNC = 0x77U;

const uint8_t YSF_END_SYNC = 0xFFU;

CYSFTX::CYSFTX() :

m_buffer(1500U),

m_poBuffer(),

m_poLen(0U),

m_poPtr(0U),

m_txDelay(240U), // 200ms

m_delay(false)

{

}

void CYSFTX::process()

{

if (m_buffer.getData() == 0U && m_poLen == 0U)

return;

if (m_poLen == 0U) {

if (!m_tx) {

m_delay = true;

m_poLen = m_txDelay;

} else {

m_delay = false;

for (uint8_t i = 0U; i < YSF_FRAME_LENGTH_BYTES; i++)

m_poBuffer[m_poLen++] = m_buffer.get();

}

m_poPtr = 0U;

}

if (m_poLen > 0U) {

uint16_t space = io.getSpace();

while (space > 8U) {

if (m_delay) {

m_poPtr++;

writeByte(YSF_START_SYNC);

}

else

writeByte(m_poBuffer[m_poPtr++]);

space -= 8U;

if (m_poPtr >= m_poLen) {

m_poPtr = 0U;

m_poLen = 0U;

m_delay = false;

return;

}

uint8_t CYSFTX::writeData(const uint8_t* data, uint8_t length)

{

if (length != (YSF_FRAME_LENGTH_BYTES + 1U))

return 4U;

uint16_t space = m_buffer.getSpace();

if (space < YSF_FRAME_LENGTH_BYTES)

return 5U;

for (uint8_t i = 0U; i < YSF_FRAME_LENGTH_BYTES; i++)

m_buffer.put(data[i + 1U]);

return 0U;

}

void CYSFTX::writeByte(uint8_t c)

{

uint8_t bit;

uint8_t mask = 0x80U;

for (uint8_t i = 0U; i < 8U; i++, c <<= 1) {

if ((c & mask) == mask)

bit = 1U;

else

bit = 0U;

io.write(&bit, 1);

}

void CYSFTX::setTXDelay(uint8_t delay)

{

m_txDelay = 600U + uint16_t(delay) * 12U; // 500ms + tx delay

}

uint16_t CYSFTX::getSpace() const

{

return m_buffer.getSpace() / YSF_FRAME_LENGTH_BYTES;

}

Sunbelt Computer Software

PL/B Language Development and Support

Navigation Menu

Repository navigation

YSFTX.cpp

YSFTX.cpp

Sunbelt Computer Software

PL/B Language Development and Support

FilesExpand file tree

YSFTX.cpp

Latest commit

History

YSFTX.cpp

File metadata and controls