The author:WildboarG
When an obstacle is detected by the radar, a high-level signal is output and a notification is sent to a personal mobile phone.
Materials- Ai-WB2-12F
- Rd-04
This project requires the use of I2C pins. Before wiring, the on-board MCU of the RD-04 must be removed. The MCU is located as shown below:
This project uses Gotify, which requires setting up a server. For details, refer to
AI-WB2 Notification Push to Personal Devices.
Enable NotificationsA simple HTTP server has been set up with a static toggle switch to control notifications, preventing frequent triggers and making the system more user-friendly.
Repository: https://github.com/WildboarG/Picket.git
Main Threadvoid rd_task(void *pvParameters) {
// Construct message content structure
static const char title[] = "RD04";
static const char message[] = "Trigger the radar notification";
static const char priority[] = "0";
static Message msg = {title, message, priority};
printf("title=%s \r\nmessage=%s\r\npriority=%s\r\n", msg.title, msg.message,
msg.priority);
while (1) {
// Continuously monitor RD output
hosal_gpio_input_get(&show, status);
vTaskDelay(3000);
// Trigger notification
if (status[0]) {
// Push message to mobile
xTaskCreate(¬ify_task, "notify_task", 1024 * 10, &msg, 5, NULL);
}
}
}
Radar Driver#include "FreeRTOS.h"
#include "hosal_i2c.h"
#include "task.h"
#include <rd04.h>
#include <stdint.h>
#include <stdio.h>
#define RD_ADDR 0x71
extern hosal_i2c_dev_t i2c0;
void IIC_WriteData(uint8_t reg_addr, uint8_t Buff) {
uint8_t Data[2];
uint8_t ret = -1;
Data[0] = reg_addr;
Data[1] = Buff;
ret = hosal_i2c_master_send(&i2c0, RD_ADDR, Data, sizeof(Data),
HOSAL_WAIT_FOREVER);
if (ret != 0) {
printf("err:%c\n", Buff);
}
}
uint8_t IIC_ReadData(uint8_t reg_addr) {
uint8_t read_data[1];
read_data[0] = reg_addr;
hosal_i2c_master_recv(&i2c0, RD_ADDR, read_data, 1, HOSAL_WAIT_FOREVER);
return read_data;
}
void RD_04_Init(void) {
printf("Initializing radar\r\n");
uint8_t value;
for (uint8_t i = 0; i < 5; i++) {
IIC_WriteData(0x13, 0x9B);
vTaskDelay(1);
value = IIC_ReadData(0x13);
printf("READ VALUE =0x%02X\r\n", value);
}
IIC_WriteData(0x24, 0x03);
IIC_WriteData(0x04, 0x20);
IIC_WriteData(0x10, 0x20);
IIC_WriteData(0x03, 0x40);
IIC_WriteData(0x1C, 0x21);
IIC_WriteData(0x18, 0x6a);
IIC_WriteData(0x19, 0x00);
IIC_WriteData(0x1A, 0x55);
IIC_WriteData(0x1B, 0x01);
IIC_WriteData(0x1D, 0x80);
IIC_WriteData(0x1E, 0x0C);
IIC_WriteData(0x1F, 0x00);
IIC_WriteData(0x20, 0x00);
IIC_WriteData(0x21, 0x7D);
IIC_WriteData(0x22, 0x00);
IIC_WriteData(0x23, 0x0C);
vTaskDelay(3000);
printf("Radar initialization successful\r\n");
}
Notification Taskvoid notify_task(void *pvParameters) {
Message *params = (Message *)pvParameters; // Receive parameters
printf("title=%s \r\nmessage=%s\r\npriority=%s\r\n", params->title,
params->message, params->priority);
const struct addrinfo hints = {
.ai_family = AF_INET,
.ai_socktype = SOCK_STREAM,
};
struct addrinfo *res;
struct in_addr *addr;
int s, r;
char recv_buf[4096];
while (1) {
int err = getaddrinfo(WEB_SERVER, WEB_PORT, &hints, &res);
if (err != 0 || res == NULL) {
blog_error("DNS lookup failed err=%d res=%p", err, res);
vTaskDelay(1000 / portTICK_PERIOD_MS);
continue;
}
addr = &((struct sockaddr_in *)res->ai_addr)->sin_addr;
blog_info("DNS lookup succeeded. IP=%s", inet_ntoa(*addr));
s = socket(res->ai_family, res->ai_socktype, 0);
if (s < 0) {
blog_error("... Failed to allocate socket.");
freeaddrinfo(res);
vTaskDelay(1000 / portTICK_PERIOD_MS);
continue;
}
blog_info("... allocated socket");
if (connect(s, res->ai_addr, res->ai_addrlen) != 0) {
blog_error("... socket connect failed errno=%d", errno);
close(s);
freeaddrinfo(res);
vTaskDelay(4000 / portTICK_PERIOD_MS);
continue;
}
blog_info("... connected");
freeaddrinfo(res);
// Construct request body
char body[1024];
snprintf(body, sizeof(body),
"--%s\r\n"
"Content-Disposition: form-data; name=\"title\"\r\n\r\n"
"%s\r\n"
"--%s\r\n"
"Content-Disposition: form-data; name=\"message\"\r\n\r\n"
"%s\r\n"
"--%s\r\n"
"Content-Disposition: form-data; name=\"priority\"\r\n\r\n"
"%s\r\n"
"--%s--\r\n",
BOUNDARY, params->title, BOUNDARY, params->message, BOUNDARY,
params->priority, BOUNDARY);
snprintf(REQUEST, sizeof(REQUEST),
"POST %s%s HTTP/1.0\r\n"
"Host: %s:%s\r\n"
"User-Agent: aithinker wb2\r\n"
"Content-Type: multipart/form-data; boundary=%s\r\n"
"Content-Length: %d\r\n"
"\r\n"
"%s",
WEB_PATH_BASE, QUERY_STRING, WEB_SERVER, WEB_PORT, BOUNDARY,
strlen(body), body);
printf(REQUEST);
if (write(s, REQUEST, strlen(REQUEST)) < 0) {
blog_error("... socket send failed");
close(s);
vTaskDelay(4000 / portTICK_PERIOD_MS);
continue;
}
blog_info("... socket send success");
struct timeval receiving_timeout;
receiving_timeout.tv_sec = 5;
receiving_timeout.tv_usec = 0;
if (setsockopt(s, SOL_SOCKET, SO_RCVTIMEO, &receiving_timeout,
sizeof(receiving_timeout)) < 0) {
blog_error("... failed to set socket receiving timeout");
close(s);
vTaskDelay(4000 / portTICK_PERIOD_MS);
continue;
}
blog_info("... set socket receiving timeout success");
extern int bl_putchar(int c);
/* Read HTTP response */
do {
bzero(recv_buf, sizeof(recv_buf));
r = read(s, recv_buf, sizeof(recv_buf) - 1);
for (int i = 0; i < r; i++) {
bl_putchar(recv_buf[i]);
}
} while (r > 0);
blog_info("... done reading from socket. Last read return=%d "
"errno=%d\r\n",
r, errno);
close(s);
for (int countdown = 10; countdown >= 0; countdown--) {
blog_info("%d... ", countdown);
vTaskDelay(1000 / portTICK_PERIOD_MS);
}
blog_info("Starting again!");
vTaskDelete(NULL);
}
}
Final Effect
Comments
Please log in or sign up to comment.