From 89fd0aa609f215a33731e8babbef13e97fff27c3 Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期二, 12 十月 2021 17:31:56 +0800
Subject: [PATCH] 超级小组汇总模式V1.45

---
 源码/核心板/Src/main.c |   17 ++++++++++++-----
 1 files changed, 12 insertions(+), 5 deletions(-)

diff --git "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c" "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c"
index 509aec6..cc9d930 100644
--- "a/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c"
+++ "b/\346\272\220\347\240\201/\346\240\270\345\277\203\346\235\277/Src/main.c"
@@ -14,7 +14,6 @@
 #include "deca_device_api.h"
 #include "Flash.h"
 //#define DEBUG_MODE
-
 void Device_Init(void)
 {
 	RCC_Configuration();
@@ -53,6 +52,7 @@
 
 extern u8 module_power;
 u16 slottime,max_slotnum,current_slotpos,dist_threshold;
+u16 supergroupid;
 void Program_Init(void)
 {uint16_t i;
 	float temp;
@@ -80,9 +80,9 @@
 		group_id=g_com_map[GROUP_ID];
 		vel_factor=g_com_map[FILTER_COEFFICIENT];
 		pos_factor=g_com_map[FILTER_COEFFICIENT];
-		dist_threshold = g_com_map[SPEEDFILTER_THRES]/(1000/g_com_map[COM_INTERVAL]);
-		if(dist_threshold<30)
-		{dist_threshold = 30;}
+		dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]);
+		if(dist_threshold<300)
+		{dist_threshold = 300;}
 		if(dist_threshold>15000)
 		{dist_threshold = 15000;}
 		if(dev_id==0)
@@ -92,7 +92,9 @@
 		{
 			module_power=67;
 		}
-		g_com_map[VERSION] = 0x0123;	
+        supergroupid = g_com_map[IMU_THRES];
+		g_com_map[VERSION] = 0x012d;	
+        g_com_map[SW_TYPE] = 	SW_MODBUS;
 	temp=(float)g_com_map[MAX_REPORT_ANC_NUM]*4/3;	
 	temp2=g_com_map[MAX_REPORT_ANC_NUM]*4/3;
 	if(temp2<temp)
@@ -203,6 +205,11 @@
 	Modbus_RegMap();
 	while(1)
 	{
+    if(g_com_map[0] != 0x55AA)
+	{
+        while(1)
+        IdleTask();	
+    }
 	if(g_start_send_flag)
 	{
 		g_start_send_flag = 0;	

--
Gitblit v1.9.3