Fisrt_commit

project/Core/Src/modbus.c

@@ -0,0 +1,97 @@
+#include "modbus.h"
+
+#include <tcp.h>
+#include <string.h>
+
+char tcp_buffer[1024];
+
+struct Data_Modbus {//registers to hold the data of the modbus
+	uint16_t reg_00;//
+	uint16_t reg_01;//
+	uint16_t reg_03;//
+};
+
+struct Data_Modbus datamodbus;
+
+/*
+static void echo_close (struct tcp_pcb *pcb )
+{
+    tcp_arg(pcb, NULL);
+    tcp_sent(pcb, NULL);
+    tcp_recv(pcb, NULL);
+    tcp_close(pcb);
+}
+
+static err_t echo_recv( void *arg, struct tcp_pcb *pcb, struct pbuf *p, err_t err )
+{
+    int i;
+    int len;
+    char *pc;
+
+    if ( err == ERR_OK && p != NULL )
+    {
+        tcp_recved( pcb, p->tot_len );
+        pc = (char *)p->payload;
+        len =p->tot_len;
+
+        for( i=0; i<len; i++ )
+        {
+            tcp_buffer[i] = pc[i];
+        }
+
+        if( tcp_buffer[0] == 'X' )
+            echo_close( pcb );
+
+        pbuf_free( p );
+
+        if( len > tcp_sndbuf( pcb ) )
+            len= tcp_sndbuf( pcb );
+
+        tcp_write( pcb, tcp_buffer, len, 0 );
+        tcp_sent( pcb, NULL );
+    }
+    else
+    {
+        pbuf_free( p );
+    }
+
+    if( err == ERR_OK && p == NULL )
+    {
+        echo_close( pcb );
+    }
+
+    return ERR_OK;
+}
+*/
+
+static void modbus_incomming_data(){
+	void *data;
+	u16_t len;
+
+
+}
+
+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
+    tcp_err( pcb, NULL );//sets the function thats called when an error ocours
+    tcp_poll( pcb, NULL, 4 );//the aplication is being polled every 4 seconds
+    tcp_write( pcb, "TEST\r\n", 8, 0 );//pcb , data , lenght in bytes , apiflags
+    printf("connected\n");
+    tcp_sent( pcb, NULL );//Specifies the callback function that should be called when data has successfully been received
+
+    return ERR_OK;
+}
+
+void modbus_init( void )
+{
+    struct tcp_pcb *tcp_pcb;
+    tcp_pcb = tcp_new();
+    tcp_bind(tcp_pcb, IP_ADDR_ANY, MODBUSPOORT);
+
+    tcp_pcb = tcp_listen( tcp_pcb );
+    tcp_accept( tcp_pcb, modbus_accept );
+}