resolved changes

Disabled logger, it gave me errors on 'TAG'
This commit is contained in:
Obe Van Lierde
2023-11-26 16:17:35 +01:00
parent 74a5983e8a
commit 2976fbf2b3
2 changed files with 122 additions and 79 deletions

View File

@@ -1,13 +1,14 @@
/*
* modbus.h
/**
* @file modbus_tcp.h
*
* Created on: 6 nov. 2023
* @brief TCP Modbus handler
* Created on: Nov 6, 2023
* Author: Obe
*/
#ifndef INC_MODBUS_H_
#define INC_MODBUS_H_
#define MODBUSPOORT 502 //is the default
#define MODBUSPORT 502 //is the default
#include <tcp.h>
@@ -18,6 +19,12 @@
#include "llfs.h"
#include "log.h"
/**
* @fn void modbus_init
* @brief Initiallises the modbus tcp
*/
void modbus_init(void);
#endif /* INC_MODBUS_H_ */

View File

@@ -1,13 +1,36 @@
#include <modbus_tcp.h>
/**
* @file modbus_tcp.c
*
* @brief TCP Modbus handler
* Created on: Nov 6, 2023
* Author: Obe
*/
// Includes
#include <modbus_tcp.h>
#include "log.h"
// Defines
#define MAX_REG 250
#define EXTENSION_LENGHT 4
#define TEXT_LENGHT 200
#define MULTIPLE_REG 0x10
#define ASCII_UNDERSCORE 95
// Global variables
char registers[MAX_REG];
//const char* TAG = "Modbus_TCP"; // Tag used in logs
// Functions
static err_t modbus_incomming_data(void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err);
static err_t modbus_accept(void *arg, struct tcp_pcb *pcb, err_t err);
void modbus_init(void);
/**
* @fn static err_t modbus_incomming_data(void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err)
* @brief Function thats called when theris a new request on port 502.
* It handles the incomming data from Qmodmaster
*/
static err_t modbus_incomming_data(void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err){
int j;
@@ -15,7 +38,6 @@ static err_t modbus_incomming_data(void *arg, struct tcp_pcb *pcb, struct pbuf *
int lenght;
char extention[EXTENSION_LENGHT];
char *pc;
char *textstring;
char text[TEXT_LENGHT];
uint8_t bg_red = 0;
uint8_t bg_green = 0;
@@ -27,111 +49,125 @@ static err_t modbus_incomming_data(void *arg, struct tcp_pcb *pcb, struct pbuf *
uint32_t result_bg = 0;
uint32_t result_txt = 0;
for(i = 0; i < 100; i++){
text[i] = ASCII_UNDERSCORE; // Putting underscores in the whole array
}
text[199] = '\0';
memcpy(text,'_',TEXT_LENGHT); // Putting underscores in the whole array
text[TEXT_LENGHT-1] = '\0';
if (p != NULL){
LOG_INFO(TAG, "data not null\n");
// here im going to procces the modbusdata
//LOG_INFO(TAG, "data not null\n");
// here im going to procces the modbusdata
tcp_recved( pcb, p->tot_len );
pc = (char*)p->payload;
len = p->tot_len;
// putting the bufer in the register array
for(int i = 0; i < len; i++) {
registers[i] = pc[i]; // getting the error "void value not ignored as it ought to be" on this line
for(int i = 0; i < len; i++) { // putting the bufer in the register array
registers[i] = pc[i]; // getting the error "void value not ignored as it ought to be" on this line
}
if(registers[7] == MULTIPLE_REG){ // Check if it's a Modbus Write Multiple Registers request (0x10)
LOG_INFO(TAG, "in writing multiple register mode\n");
}
// putting the values from the array in their variable
bg_red = (uint8_t)(registers[14]); // 01
bg_green = (uint8_t)(registers[16]); // 02
bg_blue = (uint8_t)(registers[18]); // 03
txt_red = (uint8_t)(registers[20]); // 04
txt_green = (uint8_t)(registers[22]); // 05
txt_blue = (uint8_t)(registers[24]); // 06
nr_img = (uint8_t)(registers[26]); // 07
if(registers[7] == MULTIPLE_REG){ // Check if it's a Modbus Write Multiple Registers request (0x10)
//LOG_INFO(TAG, "in writing multiple register mode\n");
bg_red = (uint8_t)(registers[14]); // 01
bg_green = (uint8_t)(registers[16]); // 02
bg_blue = (uint8_t)(registers[18]); // 03
txt_red = (uint8_t)(registers[20]); // 04
txt_green = (uint8_t)(registers[22]); // 05
txt_blue = (uint8_t)(registers[24]); // 06
nr_img = (uint8_t)(registers[26]); // 07
LOG_INFO(TAG, "%d %d %d %d %d %d %d ",bg_red,bg_green,bg_blue,txt_red,txt_green,txt_blue,nr_img);
//LOG_INFO(TAG, "%d %d %d %d %d %d %d ",bg_red,bg_green,bg_blue,txt_red,txt_green,txt_blue,nr_img);
j = 0;
for(i = 28; i < 428; i++){
if(i % 2 == 0){
text[j] = registers[i];
j++;
j = 0;
for(int i = 28; i < 428; i++){
if(i % 2 == 0){
text[j] = registers[i];
j++;
}
}
}
// processing the text data to screen
textstring = text;
result_bg = 0xff000000;
result_bg |= ((uint32_t)bg_red) << 16;
result_bg |= ((uint32_t)bg_green) << 8;
result_bg |= bg_blue;
result_bg = 0xff000000;
result_bg |= ((uint32_t)bg_red) << 16;
result_bg |= ((uint32_t)bg_green) << 8;
result_bg |= bg_blue;
result_txt = 0xff000000;
result_txt |= ((uint32_t)txt_red) << 16;
result_txt |= ((uint32_t)txt_green) << 8;
result_txt |= txt_blue;
// proccesing the image index
size_t number_of_files = llfs_file_count(); // hoeveel files er zijn
result_txt = 0xff000000;
result_txt |= ((uint32_t)txt_red) << 16;
result_txt |= ((uint32_t)txt_green) << 8;
result_txt |= txt_blue;
// proccesing the image index
size_t number_of_files = llfs_file_count(); // How many files that there are
llfs_file_t file_list[number_of_files]; // geheugen vrijmaken voor files
llfs_file_t file_list[number_of_files]; // reserving memory for the list
number_of_files = llfs_file_list(file_list, number_of_files, NULL); // vrijgemaakt geheugen invullen met de lijst
number_of_files = llfs_file_list(file_list, number_of_files, NULL); // freeed memory filled with the list
if(number_of_files < nr_img){
lcd_clear_txt(void);
lcd_clear_images(void);
lcd_display_text("FILE NOT IN FILESYSTEM", 10, 10, LCD_RED, LCD_BLACK, LCD_FONT24);
if(number_of_files < nr_img){
lcd_clear_text();
lcd_clear_images();
lcd_stop_all_gifs();
lcd_display_text(text, 10, 10, result_txt, result_bg, LCD_FONT24); //When no image
lcd_display_text("FILE NOT IN FILESYSTEM", 10, 75, LCD_RED, LCD_BLACK, LCD_FONT24);
}
else{
lenght = strlen(file_list[nr_img - 1].name); //lenght from filename
strncpy(extention, file_list[nr_img - 1].name + lenght - 3, 3); //putting the last tree digits in string
extention[3] = '\0'; //adding the \0
if(strcmp(extention,"gif") == 0){
lcd_clear_text();
lcd_clear_images();
lcd_stop_all_gifs();
lcd_display_text(text, 10, 10, result_txt, result_bg, LCD_FONT24);
lcd_gif_t* gif = lcd_draw_gif_from_fs(file_list[nr_img - 1].name, 0, 75); //GIF on screen
}
if(strcmp(extention,"bmp") == 0){
lcd_clear_text();
lcd_clear_images();
lcd_stop_all_gifs();
lcd_display_text(text, 10, 10, result_txt, result_bg, LCD_FONT24);
lcd_draw_img_from_fs(file_list[nr_img - 1].name, 0, 75); //BMP on screen
}
}
}
else{
lenght = strlen(file_list[nr_img - 1].name); //lenght from filename
strncpy(extention, file_list[nr_img - 1].name + lenght - 3, 3); //putting the last tree digits in string
extention[3] = '\0'; //adding the \0
if(strcmp(extention,"gif") == 0){
lcd_clear_txt(void);
lcd_clear_images(void);
lcd_display_text(textstring, 10, 10, result_txt, result_bg, LCD_FONT24);
lcd_gif_t* gif = lcd_draw_gif_from_fs(file_list[nr_img - 1].name, 0, 75); //GIF on screen
}
if(strcmp(extention,"bmp") == 0){
lcd_clear_txt(void);
lcd_clear_images(void);
lcd_display_text(textstring, 10, 10, result_txt, result_bg, LCD_FONT24);
lcd_draw_img_from_fs(file_list[nr_img - 1].name, 0, 75); //BMP on screen
}
//LOG_INFO(TAG, "not in writing multiple register mode!!!\n");
}
} else if (err == ERR_OK){
tcp_close(pcb); // when everithing was ok close the tcpconnection
tcp_close(pcb); // when everithing was ok close the tcpconnection
}
return ERR_OK;
}
/**
* @fn static err_t modbus_accept(void *arg, struct tcp_pcb *pcb, err_t err)
* @brief Sets the function thats being called when theirs incoming data
*/
static err_t modbus_accept(void *arg, struct tcp_pcb *pcb, err_t err)
{
LWIP_UNUSED_ARG(arg); // Eliminates compiler warning about unused arguments
LWIP_UNUSED_ARG(err); // Eliminates compiler warning about unused arguments
tcp_setprio(pcb, TCP_PRIO_MIN); // Sets the priority of a connection.
tcp_recv(pcb, modbus_incomming_data); // sets which function is being called when new data arives
LWIP_UNUSED_ARG(arg); // Eliminates compiler warning about unused arguments
LWIP_UNUSED_ARG(err); // Eliminates compiler warning about unused arguments
tcp_setprio(pcb, TCP_PRIO_MIN); // Sets the priority of a connection.
tcp_recv(pcb, modbus_incomming_data); // sets which function is being called when new data arives
return ERR_OK;
}
/**
* @fn void modbus_init
* @brief Initiallises the modbus tcp
*/
void modbus_init(void)
{
struct tcp_pcb *modbus_pcb;
modbus_pcb = tcp_new(); // creating a new tcp pcb
tcp_bind(modbus_pcb, IP_ADDR_ANY, MODBUSPOORT); // bind the modbus_pcb to port 502
modbus_pcb = tcp_new(); // creating a new tcp pcb
tcp_bind(modbus_pcb, IP_ADDR_ANY, MODBUSPORT); // bind the modbus_pcb to port 502
modbus_pcb = tcp_listen(modbus_pcb); // listen
tcp_accept(modbus_pcb, modbus_accept); // set callback function
modbus_pcb = tcp_listen(modbus_pcb); // listen
tcp_accept(modbus_pcb, modbus_accept); // set callback function
}