Compare commits
5 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 96520e1b3b | |||
| 8196c8e583 | |||
| f4c573bf88 | |||
| 060fcbb9ce | |||
| d10b64cbe6 |
@@ -51,11 +51,12 @@ Gyver433_xx<пин, буфер, CRC> xx;
|
|||||||
|
|
||||||
// === ДЕФАЙНЫ-НАСТРОЙКИ ===
|
// === ДЕФАЙНЫ-НАСТРОЙКИ ===
|
||||||
// вызывать перед подключением библиотеки
|
// вызывать перед подключением библиотеки
|
||||||
#define G433_FAST // [TX] короткая синхронизация для зелёных модулей
|
#define G433_FAST // [TX] короткая синхронизация для зелёных модулей
|
||||||
#define G433_MEDIUM // [TX] средняя синхронизация при отправке на SYN480R ЧАЩЕ 400мс (активно по умолчанию)
|
#define G433_MEDIUM // [TX] средняя синхронизация при отправке на SYN480R ЧАЩЕ 400мс (активно по умолчанию)
|
||||||
#define G433_SLOW // [TX] длинная синхронизация при отправке на SYN480R РЕЖЕ 400мс
|
#define G433_SLOW // [TX] длинная синхронизация при отправке на SYN480R РЕЖЕ 400мс
|
||||||
#define G433_MANCHESTER // [должно быть одинаково на RX и TX] интерфейс Manchester Coding для экспериментов =)
|
#define G433_MANCHESTER // [должно быть одинаково на RX и TX] интерфейс Manchester Coding для экспериментов =)
|
||||||
#define G433_SPEED 1000 // [должно быть одинаково на RX и TX] скорость 100-8000 бит/с, по умолч. 2000 бит/с
|
#define G433_SPEED 1000 // [должно быть одинаково на RX и TX] скорость 100-8000 бит/с, по умолч. 2000 бит/с
|
||||||
|
#define G433_RSSI_COUNT 10 // [RX] количество успешно принятых пакетов для расчёта RSSI (по умолч. 10)
|
||||||
```
|
```
|
||||||
|
|
||||||
<a id="usage"></a>
|
<a id="usage"></a>
|
||||||
@@ -74,6 +75,7 @@ bool readData(T &data); // прочитает буфер в любой ти
|
|||||||
uint16_t getSize(); // получить размер принятых данных
|
uint16_t getSize(); // получить размер принятых данных
|
||||||
uint16_t gotData(); // вернёт количество успешно принятых в tickISR() байт (см. пример isr_rx)
|
uint16_t gotData(); // вернёт количество успешно принятых в tickISR() байт (см. пример isr_rx)
|
||||||
uint8_t buffer[]; // доступ к буферу для отладки
|
uint8_t buffer[]; // доступ к буферу для отладки
|
||||||
|
uint8_t getRSSI(); // получить качество приёма (процент успешных передач)
|
||||||
|
|
||||||
// ============= CRC =============
|
// ============= CRC =============
|
||||||
// можно использовать встроенные функции для генерации байта CRC для ручной упаковки пакетов
|
// можно использовать встроенные функции для генерации байта CRC для ручной упаковки пакетов
|
||||||
@@ -84,7 +86,7 @@ uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
|||||||
<a id="example"></a>
|
<a id="example"></a>
|
||||||
## Примеры
|
## Примеры
|
||||||
Остальные примеры смотри в **examples**!
|
Остальные примеры смотри в **examples**!
|
||||||

|

|
||||||
### Отправка
|
### Отправка
|
||||||
```cpp
|
```cpp
|
||||||
#include <Gyver433.h>
|
#include <Gyver433.h>
|
||||||
@@ -151,6 +153,9 @@ void loop() {
|
|||||||
- v1.0
|
- v1.0
|
||||||
- v1.1 - оптимизация, новый интерфейс, поддержка дешёвых синих модулей, работа в прерывании
|
- v1.1 - оптимизация, новый интерфейс, поддержка дешёвых синих модулей, работа в прерывании
|
||||||
- v1.2 - улучшение качества связи, оптимизация работы в прерывании
|
- v1.2 - улучшение качества связи, оптимизация работы в прерывании
|
||||||
|
- v1.3 - добавлен вывод RSSI
|
||||||
|
- v1.4 - переделан FastIO
|
||||||
|
- v1.4.1 - убран FastIO, CRC вынесен отдельно
|
||||||
|
|
||||||
<a id="feedback"></a>
|
<a id="feedback"></a>
|
||||||
## Баги и обратная связь
|
## Баги и обратная связь
|
||||||
|
|||||||
@@ -31,6 +31,9 @@ void loop() {
|
|||||||
// принятые данные доступны в .buffer
|
// принятые данные доступны в .buffer
|
||||||
// и имеют размер .size
|
// и имеют размер .size
|
||||||
Serial.write(rx.buffer, rx.size);
|
Serial.write(rx.buffer, rx.size);
|
||||||
Serial.println();
|
|
||||||
|
// выведем также качество связи
|
||||||
|
Serial.print(", RSSI: ");
|
||||||
|
Serial.println(rx.getRSSI());
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -19,7 +19,7 @@ void loop() {
|
|||||||
if (++count >= 100) count = 0;
|
if (++count >= 100) count = 0;
|
||||||
|
|
||||||
// отправка данных типа byte*
|
// отправка данных типа byte*
|
||||||
tx.write(data, sizeof(data));
|
tx.write((byte*)data, sizeof(data));
|
||||||
|
|
||||||
// отправка 10 раз в сек
|
// отправка 10 раз в сек
|
||||||
delay(100);
|
delay(100);
|
||||||
|
|||||||
@@ -26,6 +26,7 @@ getSize KEYWORD2
|
|||||||
gotData KEYWORD2
|
gotData KEYWORD2
|
||||||
G433_crc8 KEYWORD2
|
G433_crc8 KEYWORD2
|
||||||
G433_crc_xor KEYWORD2
|
G433_crc_xor KEYWORD2
|
||||||
|
getRSSI KEYWORD2
|
||||||
|
|
||||||
#######################################
|
#######################################
|
||||||
# Constants (LITERAL1)
|
# Constants (LITERAL1)
|
||||||
|
|||||||
+1
-1
@@ -1,5 +1,5 @@
|
|||||||
name=Gyver433
|
name=Gyver433
|
||||||
version=1.2
|
version=1.4.1
|
||||||
author=AlexGyver <alex@alexgyver.ru>
|
author=AlexGyver <alex@alexgyver.ru>
|
||||||
maintainer=AlexGyver <alex@alexgyver.ru>
|
maintainer=AlexGyver <alex@alexgyver.ru>
|
||||||
sentence=Simple library for 433 MHz radio
|
sentence=Simple library for 433 MHz radio
|
||||||
|
|||||||
-109
@@ -1,109 +0,0 @@
|
|||||||
// Быстрый IO для AVR (для остальных будет digitalxxxxx)
|
|
||||||
// v1.0
|
|
||||||
|
|
||||||
#ifndef FastIO_h
|
|
||||||
#define FastIO_h
|
|
||||||
#include <Arduino.h>
|
|
||||||
|
|
||||||
bool fastRead(const uint8_t pin); // быстрое чтение пина
|
|
||||||
void fastWrite(const uint8_t pin, bool val); // быстрая запись
|
|
||||||
uint8_t fastShiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder); // быстрый shiftIn
|
|
||||||
void fastShiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t data); // быстрый shiftOut
|
|
||||||
|
|
||||||
// ================================================================
|
|
||||||
bool fastRead(const uint8_t pin) {
|
|
||||||
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
|
|
||||||
if (pin < 8) return bitRead(PIND, pin);
|
|
||||||
else if (pin < 14) return bitRead(PINB, pin - 8);
|
|
||||||
else if (pin < 20) return bitRead(PINC, pin - 14);
|
|
||||||
|
|
||||||
#elif defined(__AVR_ATtiny85__) || defined(__AVR_ATtiny13__)
|
|
||||||
return bitRead(PINB, pin);
|
|
||||||
|
|
||||||
#elif defined(AVR)
|
|
||||||
uint8_t *_pin_reg = portInputRegister(digitalPinToPort(pin));
|
|
||||||
uint8_t _bit_mask = digitalPinToBitMask(pin);
|
|
||||||
return bool(*_pin_reg & _bit_mask);
|
|
||||||
|
|
||||||
#else
|
|
||||||
return digitalRead(pin);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void fastWrite(const uint8_t pin, bool val) {
|
|
||||||
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
|
|
||||||
if (pin < 8) bitWrite(PORTD, pin, val);
|
|
||||||
else if (pin < 14) bitWrite(PORTB, (pin - 8), val);
|
|
||||||
else if (pin < 20) bitWrite(PORTC, (pin - 14), val);
|
|
||||||
|
|
||||||
#elif defined(__AVR_ATtiny85__) || defined(__AVR_ATtiny13__)
|
|
||||||
bitWrite(PORTB, pin, val);
|
|
||||||
|
|
||||||
#elif defined(AVR)
|
|
||||||
uint8_t *_port_reg = portInputRegister(digitalPinToPort(pin));
|
|
||||||
uint8_t _bit_mask = digitalPinToBitMask(pin);
|
|
||||||
_port_reg = portOutputRegister(digitalPinToPort(pin));
|
|
||||||
_bit_mask = digitalPinToBitMask(pin);
|
|
||||||
if (val) *_port_reg |= _bit_mask; // HIGH
|
|
||||||
else *_port_reg &= ~_bit_mask; // LOW
|
|
||||||
|
|
||||||
#else
|
|
||||||
digitalWrite(pin, val);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
uint8_t fastShiftIn(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder) {
|
|
||||||
#if defined(AVR)
|
|
||||||
volatile uint8_t *_clk_port = portOutputRegister(digitalPinToPort(clockPin));
|
|
||||||
volatile uint8_t *_dat_port = portInputRegister(digitalPinToPort(dataPin));
|
|
||||||
uint8_t _clk_mask = digitalPinToBitMask(clockPin);
|
|
||||||
uint8_t _dat_mask = digitalPinToBitMask(dataPin);
|
|
||||||
uint8_t data = 0;
|
|
||||||
for (uint8_t i = 0; i < 8; i++) {
|
|
||||||
*_clk_port |= _clk_mask;
|
|
||||||
if (bitOrder == MSBFIRST) {
|
|
||||||
data <<= 1;
|
|
||||||
if (bool(*_dat_port & _dat_mask)) data |= 1;
|
|
||||||
} else {
|
|
||||||
data >>= 1;
|
|
||||||
if (bool(*_dat_port & _dat_mask)) data |= 1 << 7;
|
|
||||||
}
|
|
||||||
*_clk_port &= ~_clk_mask;
|
|
||||||
}
|
|
||||||
return data;
|
|
||||||
#else
|
|
||||||
return shiftIn(dataPin, clockPin, bitOrder);
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void fastShiftOut(uint8_t dataPin, uint8_t clockPin, uint8_t bitOrder, uint8_t data) {
|
|
||||||
#if defined(AVR)
|
|
||||||
volatile uint8_t *_clk_port = portOutputRegister(digitalPinToPort(clockPin));
|
|
||||||
volatile uint8_t *_dat_port = portOutputRegister(digitalPinToPort(dataPin));
|
|
||||||
uint8_t _clk_mask = digitalPinToBitMask(clockPin);
|
|
||||||
uint8_t _dat_mask = digitalPinToBitMask(dataPin);
|
|
||||||
for (uint8_t i = 0; i < 8; i++) {
|
|
||||||
if (bitOrder == MSBFIRST) {
|
|
||||||
if (data & (1 << 7)) *_dat_port |= _dat_mask;
|
|
||||||
else *_dat_port &= ~_dat_mask;
|
|
||||||
data <<= 1;
|
|
||||||
} else {
|
|
||||||
if (data & 1) *_dat_port |= _dat_mask;
|
|
||||||
else *_dat_port &= ~_dat_mask;
|
|
||||||
data >>= 1;
|
|
||||||
}
|
|
||||||
*_clk_port |= _clk_mask;
|
|
||||||
*_clk_port &= ~_clk_mask;
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
shiftOut(dataPin, clockPin, bitOrder, data);
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@@ -0,0 +1,41 @@
|
|||||||
|
#include "G433_crc.h"
|
||||||
|
|
||||||
|
void G433_crc8_byte(uint8_t &crc, uint8_t data) {
|
||||||
|
#if defined (__AVR__)
|
||||||
|
// резкий алгоритм для AVR
|
||||||
|
uint8_t counter;
|
||||||
|
uint8_t buffer;
|
||||||
|
asm volatile (
|
||||||
|
"EOR %[crc_out], %[data_in] \n\t"
|
||||||
|
"LDI %[counter], 8 \n\t"
|
||||||
|
"LDI %[buffer], 0x8C \n\t"
|
||||||
|
"_loop_start_%=: \n\t"
|
||||||
|
"LSR %[crc_out] \n\t"
|
||||||
|
"BRCC _loop_end_%= \n\t"
|
||||||
|
"EOR %[crc_out], %[buffer] \n\t"
|
||||||
|
"_loop_end_%=: \n\t"
|
||||||
|
"DEC %[counter] \n\t"
|
||||||
|
"BRNE _loop_start_%="
|
||||||
|
: [crc_out]"=r" (crc), [counter]"=d" (counter), [buffer]"=d" (buffer)
|
||||||
|
: [crc_in]"0" (crc), [data_in]"r" (data)
|
||||||
|
);
|
||||||
|
#else
|
||||||
|
// обычный для всех остальных
|
||||||
|
uint8_t i = 8;
|
||||||
|
while (i--) {
|
||||||
|
crc = ((crc ^ data) & 1) ? (crc >> 1) ^ 0x8C : (crc >> 1);
|
||||||
|
data >>= 1;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t G433_crc8(uint8_t *buffer, uint8_t size) {
|
||||||
|
uint8_t crc = 0;
|
||||||
|
for (uint8_t i = 0; i < size; i++) G433_crc8_byte(crc, buffer[i]);
|
||||||
|
return crc;
|
||||||
|
}
|
||||||
|
uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size) {
|
||||||
|
uint8_t crc = 0;
|
||||||
|
for (uint8_t i = 0; i < size; i++) crc ^= buffer[i];
|
||||||
|
return crc;
|
||||||
|
}
|
||||||
@@ -0,0 +1,7 @@
|
|||||||
|
#ifndef G433_crc_h
|
||||||
|
#define G433_crc_h
|
||||||
|
#include <Arduino.h>
|
||||||
|
uint8_t G433_crc8(uint8_t *buffer, uint8_t size); // ручной CRC8
|
||||||
|
uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
||||||
|
void G433_crc8_byte(uint8_t &crc, uint8_t data); // crc8 один байт
|
||||||
|
#endif
|
||||||
+60
-58
@@ -18,15 +18,16 @@
|
|||||||
v1.0 - релиз
|
v1.0 - релиз
|
||||||
v1.1 - оптимизация, новый интерфейс, поддержка дешёвых синих модулей, работа в прерывании
|
v1.1 - оптимизация, новый интерфейс, поддержка дешёвых синих модулей, работа в прерывании
|
||||||
v1.2 - улучшение качества связи, оптимизация работы в прерывании
|
v1.2 - улучшение качества связи, оптимизация работы в прерывании
|
||||||
|
v1.3 - добавлен вывод RSSI
|
||||||
|
v1.4 - переделан FastIO
|
||||||
|
v1.4.1 - убран FastIO, CRC вынесен отдельно
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef Gyver433_h
|
#ifndef Gyver433_h
|
||||||
#define Gyver433_h
|
#define Gyver433_h
|
||||||
#include <Arduino.h>
|
#include <Arduino.h>
|
||||||
#include "FastIO.h"
|
#include "G433_crc.h"
|
||||||
|
|
||||||
uint8_t G433_crc8(uint8_t *buffer, uint8_t size); // ручной CRC8
|
|
||||||
uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
|
||||||
#define TRAINING_TIME_SLOW (500000ul) // время синхронизации для SLOW_MODE
|
#define TRAINING_TIME_SLOW (500000ul) // время синхронизации для SLOW_MODE
|
||||||
|
|
||||||
// =========================================================================
|
// =========================================================================
|
||||||
@@ -34,6 +35,10 @@ uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
|||||||
#define G433_SPEED 2000
|
#define G433_SPEED 2000
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifndef G433_RSSI_COUNT
|
||||||
|
#define G433_RSSI_COUNT 10
|
||||||
|
#endif
|
||||||
|
|
||||||
// тайминги интерфейса
|
// тайминги интерфейса
|
||||||
#define FRAME_TIME (1000000ul / G433_SPEED) // время фрейма (либо HIGH)
|
#define FRAME_TIME (1000000ul / G433_SPEED) // время фрейма (либо HIGH)
|
||||||
#define HALF_FRAME (FRAME_TIME / 2) // полфрейма (либо LOW)
|
#define HALF_FRAME (FRAME_TIME / 2) // полфрейма (либо LOW)
|
||||||
@@ -55,9 +60,9 @@ uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
// режимы CRC
|
// режимы CRC
|
||||||
#define G433_CRC8 0
|
#define G433_NOCRC 0
|
||||||
#define G433_XOR 1
|
#define G433_CRC8 1
|
||||||
#define G433_NOCRC 2
|
#define G433_XOR 2
|
||||||
|
|
||||||
// количество синхроимпульсов
|
// количество синхроимпульсов
|
||||||
#if defined(G433_FAST)
|
#if defined(G433_FAST)
|
||||||
@@ -70,9 +75,6 @@ uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size); // ручной CRC XOR
|
|||||||
#define TRAINING_PULSES 50
|
#define TRAINING_PULSES 50
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// crc8 один байт
|
|
||||||
void G433_crc8_byte(uint8_t &crc, uint8_t data);
|
|
||||||
|
|
||||||
// ============ ПЕРЕДАТЧИК ============
|
// ============ ПЕРЕДАТЧИК ============
|
||||||
template <uint8_t TX_PIN, uint16_t TX_BUF = 64, uint8_t CRC_MODE = G433_CRC8>
|
template <uint8_t TX_PIN, uint16_t TX_BUF = 64, uint8_t CRC_MODE = G433_CRC8>
|
||||||
class Gyver433_TX {
|
class Gyver433_TX {
|
||||||
@@ -83,7 +85,8 @@ public:
|
|||||||
|
|
||||||
// отправка, блокирующая. Кушает любой тип данных
|
// отправка, блокирующая. Кушает любой тип данных
|
||||||
template <typename T>
|
template <typename T>
|
||||||
void sendData(T &data) {
|
bool sendData(T &data) {
|
||||||
|
if (sizeof(T) > TX_BUF) return 0;
|
||||||
const uint8_t *ptr = (const uint8_t*) &data;
|
const uint8_t *ptr = (const uint8_t*) &data;
|
||||||
for (uint16_t i = 0; i < sizeof(T); i++) buffer[i] = *ptr++;
|
for (uint16_t i = 0; i < sizeof(T); i++) buffer[i] = *ptr++;
|
||||||
if (CRC_MODE == G433_CRC8) {
|
if (CRC_MODE == G433_CRC8) {
|
||||||
@@ -95,6 +98,7 @@ public:
|
|||||||
} else {
|
} else {
|
||||||
write(buffer, sizeof(T));
|
write(buffer, sizeof(T));
|
||||||
}
|
}
|
||||||
|
return 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
// отправка сырого набора байтов
|
// отправка сырого набора байтов
|
||||||
@@ -137,9 +141,20 @@ public:
|
|||||||
}
|
}
|
||||||
|
|
||||||
// доступ к буферу
|
// доступ к буферу
|
||||||
uint8_t buffer[TX_BUF];
|
uint8_t buffer[TX_BUF + !!CRC_MODE];
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
void fastWrite(const uint8_t pin, bool val) {
|
||||||
|
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
|
||||||
|
if (pin < 8) bitWrite(PORTD, pin, val);
|
||||||
|
else if (pin < 14) bitWrite(PORTB, (pin - 8), val);
|
||||||
|
else if (pin < 20) bitWrite(PORTC, (pin - 14), val);
|
||||||
|
#elif defined(__AVR_ATtiny85__) || defined(__AVR_ATtiny13__)
|
||||||
|
bitWrite(PORTB, pin, val);
|
||||||
|
#else
|
||||||
|
digitalWrite(pin, val);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
// ============ ПРИЁМНИК ============
|
// ============ ПРИЁМНИК ============
|
||||||
@@ -186,18 +201,31 @@ public:
|
|||||||
uint16_t gotData() {
|
uint16_t gotData() {
|
||||||
if (parse == 2 && millis() - tmr2 >= 10) { // фрейм не закрыт
|
if (parse == 2 && millis() - tmr2 >= 10) { // фрейм не закрыт
|
||||||
parse = size = 0; // приём окончен
|
parse = size = 0; // приём окончен
|
||||||
if (byteCount > 1) { // если что то приняли
|
if (byteCount > (1 + !!CRC_MODE)) { // если что то приняли
|
||||||
if (CRC_MODE == G433_CRC8) { // CRC8
|
if (!bitCount) { // байт закрыт
|
||||||
if (!G433_crc8(buffer, byteCount)) size = byteCount - 2;
|
if (CRC_MODE == G433_CRC8) { // CRC8
|
||||||
} else if (CRC_MODE == G433_XOR) { // CRC XOR
|
if (!G433_crc8(buffer, byteCount)) size = byteCount - 2;
|
||||||
if (!G433_crc_xor(buffer, byteCount)) size = byteCount - 2;
|
} else if (CRC_MODE == G433_XOR) { // CRC XOR
|
||||||
} else size = byteCount - 1; // без CRC
|
if (!G433_crc_xor(buffer, byteCount)) size = byteCount - 2;
|
||||||
|
} else size = byteCount - 1; // без CRC
|
||||||
|
}
|
||||||
|
// расчёт RSSI
|
||||||
|
if (!size) errCount++;
|
||||||
|
if (++rcCount >= G433_RSSI_COUNT) {
|
||||||
|
RSSI = 100 - errCount * 100 / G433_RSSI_COUNT;
|
||||||
|
errCount = rcCount = 0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
return size;
|
return size;
|
||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// получить качество приёма (процент успешных передач)
|
||||||
|
uint8_t getRSSI() {
|
||||||
|
return RSSI;
|
||||||
|
}
|
||||||
|
|
||||||
// получить размер принятых данных
|
// получить размер принятых данных
|
||||||
uint16_t getSize() {
|
uint16_t getSize() {
|
||||||
return size;
|
return size;
|
||||||
@@ -207,9 +235,22 @@ public:
|
|||||||
uint16_t size = 0;
|
uint16_t size = 0;
|
||||||
|
|
||||||
// доступ к буферу
|
// доступ к буферу
|
||||||
uint8_t buffer[RX_BUF];
|
uint8_t buffer[RX_BUF + !!CRC_MODE];
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
bool fastRead(const uint8_t pin) {
|
||||||
|
#if defined(__AVR_ATmega328P__) || defined(__AVR_ATmega168__)
|
||||||
|
if (pin < 8) return bitRead(PIND, pin);
|
||||||
|
else if (pin < 14) return bitRead(PINB, pin - 8);
|
||||||
|
else if (pin < 20) return bitRead(PINC, pin - 14);
|
||||||
|
#elif defined(__AVR_ATtiny85__) || defined(__AVR_ATtiny13__)
|
||||||
|
return bitRead(PINB, pin);
|
||||||
|
#else
|
||||||
|
return digitalRead(pin);
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
bool pinChanged() {
|
bool pinChanged() {
|
||||||
bit = fastRead(RX_PIN);
|
bit = fastRead(RX_PIN);
|
||||||
if (bit != prevBit) {
|
if (bit != prevBit) {
|
||||||
@@ -268,46 +309,7 @@ private:
|
|||||||
uint8_t parse = 0;
|
uint8_t parse = 0;
|
||||||
uint32_t tmr = 0, tmr2 = 0;
|
uint32_t tmr = 0, tmr2 = 0;
|
||||||
uint8_t bitCount = 0, byteCount = 0;
|
uint8_t bitCount = 0, byteCount = 0;
|
||||||
|
uint8_t errCount = 0, rcCount = 0, RSSI = 0;
|
||||||
};
|
};
|
||||||
|
|
||||||
// ===== CRC =====
|
|
||||||
void G433_crc8_byte(uint8_t &crc, uint8_t data) {
|
|
||||||
#if defined (__AVR__)
|
|
||||||
// резкий алгоритм для AVR
|
|
||||||
uint8_t counter;
|
|
||||||
uint8_t buffer;
|
|
||||||
asm volatile (
|
|
||||||
"EOR %[crc_out], %[data_in] \n\t"
|
|
||||||
"LDI %[counter], 8 \n\t"
|
|
||||||
"LDI %[buffer], 0x8C \n\t"
|
|
||||||
"_loop_start_%=: \n\t"
|
|
||||||
"LSR %[crc_out] \n\t"
|
|
||||||
"BRCC _loop_end_%= \n\t"
|
|
||||||
"EOR %[crc_out], %[buffer] \n\t"
|
|
||||||
"_loop_end_%=: \n\t"
|
|
||||||
"DEC %[counter] \n\t"
|
|
||||||
"BRNE _loop_start_%="
|
|
||||||
: [crc_out]"=r" (crc), [counter]"=d" (counter), [buffer]"=d" (buffer)
|
|
||||||
: [crc_in]"0" (crc), [data_in]"r" (data)
|
|
||||||
);
|
|
||||||
#else
|
|
||||||
// обычный для всех остальных
|
|
||||||
uint8_t i = 8;
|
|
||||||
while (i--) {
|
|
||||||
crc = ((crc ^ data) & 1) ? (crc >> 1) ^ 0x8C : (crc >> 1);
|
|
||||||
data >>= 1;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t G433_crc8(uint8_t *buffer, uint8_t size) {
|
|
||||||
uint8_t crc = 0;
|
|
||||||
for (uint8_t i = 0; i < size; i++) G433_crc8_byte(crc, buffer[i]);
|
|
||||||
return crc;
|
|
||||||
}
|
|
||||||
uint8_t G433_crc_xor(uint8_t *buffer, uint8_t size) {
|
|
||||||
uint8_t crc = 0;
|
|
||||||
for (uint8_t i = 0; i < size; i++) crc ^= buffer[i];
|
|
||||||
return crc;
|
|
||||||
}
|
|
||||||
#endif
|
#endif
|
||||||
Reference in New Issue
Block a user