168 lines
3.6 KiB
C++
168 lines
3.6 KiB
C++
/*
|
|
* Copyright (C) OpenTX
|
|
*
|
|
* Based on code named
|
|
* th9x - http://code.google.com/p/th9x
|
|
* er9x - http://code.google.com/p/er9x
|
|
* gruvin9x - http://code.google.com/p/gruvin9x
|
|
*
|
|
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#ifndef _PULSES_PXX1_H_
|
|
#define _PULSES_PXX1_H_
|
|
|
|
#include "pxx.h"
|
|
|
|
class Pxx1CrcMixin {
|
|
protected:
|
|
void initCrc()
|
|
{
|
|
crc = 0;
|
|
}
|
|
|
|
void addToCrc(uint8_t byte)
|
|
{
|
|
crc = (crc << 8) ^ (CRCTable[((crc >> 8) ^ byte) & 0xFF]);
|
|
}
|
|
|
|
uint16_t crc;
|
|
static const uint16_t CRCTable[];
|
|
};
|
|
|
|
template <class BitTransport>
|
|
class StandardPxx1Transport: public BitTransport, public Pxx1CrcMixin {
|
|
protected:
|
|
uint8_t ones_count;
|
|
|
|
void initFrame(uint32_t period)
|
|
{
|
|
BitTransport::initFrame(period);
|
|
ones_count = 0;
|
|
}
|
|
|
|
void addByte(uint8_t byte)
|
|
{
|
|
Pxx1CrcMixin::addToCrc(byte);
|
|
addByteWithoutCrc(byte);
|
|
};
|
|
|
|
void addRawByte(uint8_t byte)
|
|
{
|
|
for (uint8_t i = 0; i < 8; i++) {
|
|
if (byte & 0x80)
|
|
BitTransport::addPart(1);
|
|
else
|
|
BitTransport::addPart(0);
|
|
byte <<= 1;
|
|
}
|
|
}
|
|
|
|
void addByteWithoutCrc(uint8_t byte)
|
|
{
|
|
for (uint8_t i = 0; i < 8; i++) {
|
|
addBit(byte & 0x80);
|
|
byte <<= 1;
|
|
}
|
|
}
|
|
|
|
void addBit(uint8_t bit)
|
|
{
|
|
if (bit) {
|
|
BitTransport::addPart(1);
|
|
if (++ones_count == 5) {
|
|
ones_count = 0;
|
|
BitTransport::addPart(0); // Stuff a 0 bit in
|
|
}
|
|
}
|
|
else {
|
|
BitTransport::addPart(0);
|
|
ones_count = 0;
|
|
}
|
|
}
|
|
};
|
|
|
|
class UartPxx1Transport: public DataBuffer<uint8_t, 64>, public Pxx1CrcMixin {
|
|
protected:
|
|
void initFrame(uint32_t period)
|
|
{
|
|
initBuffer();
|
|
}
|
|
|
|
void addByte(uint8_t byte)
|
|
{
|
|
Pxx1CrcMixin::addToCrc(byte);
|
|
addWithByteStuffing(byte);
|
|
}
|
|
|
|
void addRawByte(uint8_t byte)
|
|
{
|
|
*ptr++ = byte;
|
|
}
|
|
|
|
void addByteWithoutCrc(uint8_t byte)
|
|
{
|
|
addWithByteStuffing(byte);
|
|
}
|
|
|
|
void addWithByteStuffing(uint8_t byte)
|
|
{
|
|
if (0x7E == byte) {
|
|
addRawByte(0x7D);
|
|
addRawByte(0x5E);
|
|
}
|
|
else if (0x7D == byte) {
|
|
addRawByte(0x7D);
|
|
addRawByte(0x5D);
|
|
}
|
|
else {
|
|
addRawByte(byte);
|
|
}
|
|
}
|
|
|
|
void addTail()
|
|
{
|
|
// nothing
|
|
}
|
|
};
|
|
|
|
template <class PxxTransport>
|
|
class Pxx1Pulses: public PxxPulses<PxxTransport>
|
|
{
|
|
public:
|
|
void setupFrame(uint8_t port);
|
|
|
|
protected:
|
|
void addHead()
|
|
{
|
|
// send 7E, do not CRC
|
|
PxxTransport::addRawByte(0x7E);
|
|
}
|
|
|
|
void addCrc()
|
|
{
|
|
PxxTransport::addByteWithoutCrc(Pxx1CrcMixin::crc >> 8);
|
|
PxxTransport::addByteWithoutCrc(Pxx1CrcMixin::crc);
|
|
}
|
|
|
|
uint8_t addFlag1(uint8_t port);
|
|
void addExtraFlags(uint8_t port);
|
|
void addChannels(uint8_t port, uint8_t sendFailsafe, uint8_t sendUpperChannels);
|
|
void add8ChannelsFrame(uint8_t port, uint8_t sendUpperChannels);
|
|
};
|
|
|
|
typedef Pxx1Pulses<UartPxx1Transport> UartPxx1Pulses;
|
|
typedef Pxx1Pulses<StandardPxx1Transport<PwmPxxBitTransport>> PwmPxx1Pulses;
|
|
typedef Pxx1Pulses<StandardPxx1Transport<SerialPxxBitTransport>> SerialPxx1Pulses;
|
|
|
|
#endif
|