修改驱动程序

2023-05-19 18:02:00 +08:00
1 parent 063c3fcc07
commit a69c1a58d6
@@ -0,0 +1,172 @@
+
+#include "main.h"
+
+#include "os-app.h"
+
+#include <stdio.h>
+#include <rtthread.h>
+#include <net-app.h>
+#include <easyflash.h>
+#include <string.h>
+#include "usart-board.h"
+#include "modbus-s.h"
+#include "modbusaddr.h"
+
+
+ALIGN(RT_ALIGN_SIZE)
+static char thread_stack[4096];
+static struct rt_thread probus_thread;
+
+
+uint16_t REG_DATA[REG_MAX] = {0x00};
+
+
+
+// 寄存器对应的数据
+
+
+
+
+//	case ssKHYSet:
+//		{
+//			vv = value*10;
+//			dbg_printf ("MbusSetValue vv:%d\r\n",vv);
+//			sendcmd[type][4] = ((vv >> 8) & 0xff);
+//			sendcmd[type][5] = (vv  & 0xff);
+//			vv = bsp_crc_calc16((uint8_t *)sendcmd[type],6);
+//			sendcmd[type][7] = ((vv >> 8) & 0xff);
+//			sendcmd[type][6] = (vv  & 0xff);
+//			for(int i = 0;i < 8;i++)
+//			{
+//				dbg_printf("%02X ",sendcmd[type][i]);
+//			}
+//			dbg_printf("\r\n");
+//		}
+
+//	{0x01, 0x03, 0x00, 0x00, 0x00, 0x06, 0xC5, 0xC8}, // 闸位计读取开度
+//	{0x01, 0x06, 0x00, 0x07, 0x00, 0x02, 0xE6, 0x69}, // 闸位计设置开度
+//	{0x01, 0x06, 0x00, 0x04, 0x01, 0x00, 0xC9, 0x9B}, // 启动闸位计
+//	{0x01, 0x06, 0x00, 0x04, 0x00, 0x00, 0xC8, 0x0B}, // 停止闸位计
+
+
+static ModBusSlave_t modbus_slave;
+static uint8_t modbus_rx_data[32];
+
+
+static void eth2_data_rxdone(void) 
+{
+	rt_event_send(gUartEvents,EVENT_UART_ETH2_RX);
+	//rt_kprintf("net_data_rxdone\r\n");
+}
+
+
+static void probus_handle(uint16_t addr,uint8_t * data)
+{
+	switch (addr)
+	{
+		case REG_SOPEN:   // 设定闸门开度
+			break;
+		case REG_SLOPT:   // 执行闸门动作
+			if (data[0] == 0x01)   // 执行
+			{
+				rt_event_send(gCtrlEvents,EVENT_CTRL_SET_OPEN);	
+				rt_kprintf("probus_handle set open\r\n");				
+			}
+			else
+			{
+				
+			}				
+			
+			break;
+		default:
+			break;
+	}
+}
+
+
+static void thread_entry(void  * argument)
+{
+
+	int k = 0;
+	uint8_t txbuff[128] = {0};
+	int tx_size = 0;
+	rt_kprintf("%s was start!\r\n",__FILE__);
+
+	g_ETH2Drv.rxdone =  eth2_data_rxdone;
+	g_ETH2Drv.BaudRate = 115200;
+	MX_UART_Init(&g_ETH2Drv);
+	
+	ModbusSlaveInit(&modbus_slave,0x01,modbus_rx_data,REG_DATA,REG_MAX);
+	// 注册网络驱动
+	// 注册网络驱动
+    while (1)
+    {
+		if( RT_EOK == rt_event_recv( gUartEvents, EVENT_UART_ETH2_RX,RT_EVENT_FLAG_AND | RT_EVENT_FLAG_CLEAR, RT_WAITING_NO, RT_NULL ))
+		{
+//			rt_kprintf("<<<<<<<<<<<<<<<<<<<<probus2:\r\n");
+//			for(int i =0; i < g_ETH2Drv.rx_size;i++)
+//			{
+//				rt_kprintf("%02X ",g_ETH2Drv.rx_buffer[i]);
+//			}
+//			rt_kprintf("\r\n");
+			k = ModbusSlaveHandle(&modbus_slave,(uint8_t *)g_ETH2Drv.rx_buffer,g_ETH2Drv.rx_size);
+			//rt_kprintf("k:%d\r\n",k);
+			if( k == 0)
+			{
+				switch (modbus_slave.func)
+				{
+					case 0x03:
+						tx_size = ModbusSlavePacket(&modbus_slave,txbuff);
+						// 直接返回当前寄存器中的数据
+						break;
+					case 0x06:
+						//处理对应的事件
+						probus_handle(modbus_slave.Addr,modbus_slave.data);
+						// 数据打包回复
+						tx_size = ModbusSlavePacket(&modbus_slave,txbuff);
+						break;
+					default:
+						tx_size = 0;
+						break;
+				}
+			}
+			else
+			{
+				tx_size = 0;
+			}
+			if (tx_size > 0)
+			{
+				MX_UART_PutBuffer(&g_ETH2Drv,(char *)txbuff,tx_size);			
+			}
+			
+			MX_UART_Clear(&g_ETH2Drv);
+		}
+		rt_thread_delay(10);
+    }
+
+}
+
+void PROBUS_APPThreadStart(void )
+{
+	/* 创建线程1，名称是thread1，入口是thread1_entry*/
+    rt_thread_init(&probus_thread, "probus_thread",
+                   thread_entry, RT_NULL,
+                   &thread_stack[0],
+					sizeof(thread_stack),
+                   PROBUS_APP_THREAD_PRIORITY,  PROBUS_APP_THREAD_TIMESLICE);
+    rt_thread_startup(&probus_thread);
+
+    return ;
+}
+
+
+
+
+
+
+
+
+
+
+
+