raspberrypi/433MHZ/rc-switch-pico/examples/Forward/Forward.cc
2023-04-18 19:42:00 +08:00

220 lines
5.2 KiB
C++

#include <iostream>
#include "pico/stdlib.h"
#include "../../radio-switch.h"
#include "pico/stdio.h"
#include "pico/multicore.h"
#include <map> // map
#include <time.h>
#define BUFFER_SIZ 270
const uint LED_PIN = PICO_DEFAULT_LED_PIN;
const uint RADIO_TRANSMIT_PIN = 16; // 433发射模块引脚
const uint RADIO_RECEIVER_PIN = 17; // 433接收模块引脚
const uint PASSWD_LEN = 3; // 随机数几位
const uint QUEUES_NUM = 3; // 队列数量, 满了发送
const uint QUEUES_WAIT = 60; // 队列等待时间, 单位秒, 队列未满时
char ins[] = "55";
char outs = '1';
// 闪烁LED
static void light()
{
gpio_init(LED_PIN);
gpio_set_dir(LED_PIN, GPIO_OUT);
gpio_put(LED_PIN, 1);
sleep_ms(100);
gpio_put(LED_PIN, 0);
sleep_ms(100);
return ;
}
static const char pool[] = {
'1', '2', '3', '4', '5', '6', '7', '8', '9'
};
// 随即数
static int RAND()
{
char password[BUFFER_SIZ];
int i = 0;
FILE *fp;
memset(password, 0, BUFFER_SIZ);
srand(time(NULL));
while (i != PASSWD_LEN) {
password[i++] = pool[rand() % sizeof(pool)];
}
//printf("%d\n", atoi(password));
return atoi(password);
}
static void SEND(const int ID)
{
int RANDOM = 500;
const int LOOP_NUM = 1; // 循环发送次数
const uint PULSE_LENGTH = 169; // set this to PULSELENGTH RECIEVED
const uint REPEAT_TRANSMIT = 5; // set this to whatever works best for you. // 重复发送
const uint PROTOCOL = 1; // set this to PROTOCOL RECIEVED
const uint BIT_LENGTH = 24; // set this to BIT LENGTH RECIEVED
gpio_init(RADIO_TRANSMIT_PIN);
RCSwitch mySwitch = RCSwitch();
mySwitch.enableTransmit(RADIO_TRANSMIT_PIN);
mySwitch.setProtocol(PROTOCOL);
mySwitch.setPulseLength(PULSE_LENGTH);
mySwitch.setRepeatTransmit(REPEAT_TRANSMIT);
for (int i = 0; i <= LOOP_NUM; i++) {
RANDOM = RAND();
light(); // 灯闪烁
sleep_ms(RANDOM * 2 / 3); // 等待随机时间
mySwitch.send(ID, BIT_LENGTH); // 发射
sleep_ms(100);
}
return ;
}
static int int_string(int val, char *inchars, int SIZE, int *inchars_len, char *outchars, int *outchars_len)
{
memset(inchars, 0, SIZE);
memset(outchars, 0, SIZE);
snprintf(inchars, SIZE, "%d", val);
*inchars_len = strlen(inchars);
if (0 == strncasecmp(inchars, ins, 2)) {
outchars[0] = outs;
outchars[1] = outs;
strncpy(outchars + 2, inchars + 2, (*inchars_len) - 2);
*outchars_len = strlen(outchars);
}
return 0;
}
// 核心0发送数据到核心1, 核心1判断是否有数据到来, 然后打印.
static void core1_main()
{
gpio_init(RADIO_RECEIVER_PIN);
RCSwitch rcSwitch = RCSwitch();
rcSwitch.enableReceive(RADIO_RECEIVER_PIN);
char inchars[BUFFER_SIZ];
char outchars[BUFFER_SIZ];
int inchars_len;
int outchars_len;
while (true)
{
if (rcSwitch.available())
{
light(); // 灯闪烁
uint32_t val = rcSwitch.getReceivedValue();
int_string(val, inchars, BUFFER_SIZ, &inchars_len, outchars, &outchars_len);
if (val != 0)
{
if (inchars[0] == ins[0] && inchars[1] == ins[1])
{
multicore_fifo_push_blocking(atoi(outchars));
}
else
{
rcSwitch.resetAvailable();
val = 0;
continue;
}
}
rcSwitch.resetAvailable();
val = 0;
}
sleep_ms(100);
}
return ;
}
int main(void)
{
stdio_init_all();
std::map < int, int >idcode;
int count=0;
uint32_t i=0;
multicore_reset_core1();
multicore_launch_core1(core1_main);
while (1)
{
if (multicore_fifo_rvalid())
{
i = multicore_fifo_pop_blocking(); // 读取核心1发送来的数据
idcode.insert( { // 插入map
i, i}
);
}
if (idcode.size() >= QUEUES_NUM) // 等于3个时发送
{
for (auto it: idcode)
{
printf("核心0转发433MHZ %u\n", it.first);
SEND(it.first);
}
idcode.clear();
}
else // 一直没有3个时候, 过一段时间发送
{
count++; // 计数
if (count == QUEUES_WAIT*10) // 秒
{
for (auto it: idcode)
{
printf("核心0转发433MHZ %u\n", it.first);
SEND(it.first);
}
idcode.clear();
count = 0;
}
}
sleep_ms(10);
}
return 0;
}