From fc057b986700bbb5dd6bac94c40b4093f2751f7f Mon Sep 17 00:00:00 2001 From: zhyinch <zhyinch@gmail.com> Date: 星期六, 31 十月 2020 16:13:51 +0800 Subject: [PATCH] V2.7 固定时间片9标签20HZ测试通过 --- 源码/核心板/Src/main.c | 68 +++++++++++++++++++++++++++------ 1 files changed, 55 insertions(+), 13 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 f7c4e53..a842d31 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" @@ -48,6 +48,29 @@ u16 slottime,max_slotpos; extern u8 module_power; extern u16 total_slotnum; +void ComMapCheck(void) +{ + if(g_com_map[COM_INTERVAL]<10) + { + g_com_map[COM_INTERVAL]=500; + } + if(g_com_map[COM_INTERVAL]>1000) + { + g_com_map[COM_INTERVAL]=1000; + } + if(module_power>MAX_RFPOWER) + {module_power=MAX_RFPOWER;} + if(module_power<0) + {module_power=0;} + if(g_com_map[MAX_REPORT_ANC_NUM]>10) + {g_com_map[MAX_REPORT_ANC_NUM]=10;} + if(g_com_map[MAX_REPORT_ANC_NUM]<1) + {g_com_map[MAX_REPORT_ANC_NUM]=1;} + if(g_com_map[IMU_THRES]>10) + {g_com_map[IMU_THRES]=10;} + if(g_com_map[IMU_THRES]<1) + {g_com_map[IMU_THRES]=1;} +} void Program_Init(void) { float temp; u16 temp2; @@ -63,22 +86,25 @@ // g_com_map[MAX_REPORT_ANC_NUM]=3; // g_com_map[NEARBASE_NUM]=1; // g_com_map[NEARBASE_ID1]=2; - g_com_map[ANC_FLAG]=1; - save_com_map_to_flash(); +// g_com_map[ANC_FLAG]=1; +// save_com_map_to_flash(); + g_com_map[BASESYNCSEQ]=0; + g_com_map[SYNCBASEID]=0x9751; #endif OUT485_ENABLE; - g_com_map[VERSION] = 0x0112; + ComMapCheck(); + g_com_map[VERSION] = 0x0207; dev_id = g_com_map[DEV_ID]; - slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]/4)+4; + slottime=ceil((double)g_com_map[MAX_REPORT_ANC_NUM]*SLOT_SCALE)+3; max_slotpos=g_com_map[COM_INTERVAL]/slottime; tyncpoll_time=(g_com_map[DEV_ID]%max_slotpos)*slottime; module_power = g_com_map[POWER]; total_slotnum = 1000/g_com_map[COM_INTERVAL]; - if(module_power>67) - { - module_power=67; - } + anchor_type = dev_id%3; +// g_com_map[BASESYNCSEQ]=0; +// g_com_map[SYNCBASEID]=2; + if(g_com_map[DEV_ROLE]) { printf("标签ID: %d .\r\n",dev_id); @@ -86,7 +112,6 @@ printf("单次通讯基站数量: %d个.\r\n",g_com_map[MAX_REPORT_ANC_NUM]); }else{ - anchor_type = dev_id%g_com_map[MAX_REPORT_ANC_NUM]; printf("基站ID: %x .\r\n",dev_id); printf("基站类型: %c .\r\n",anchor_type+0x41); printf("单次通讯基站数量: %d个.\r\n",g_com_map[MAX_REPORT_ANC_NUM]); @@ -111,8 +136,17 @@ * * @return none */ +extern u16 synclost_count; void HeatBeat(void) -{ +{ u16 checksum; + if(synclost_count>5) + { + hbsend[6] = 0; + }else{ + hbsend[6] = 1; + } +checksum = Checksum_u16(&hbsend[2],12); +memcpy(&hbsend[14],&checksum,2); UART_PushFrame(hbsend,16); } extern u8 g_start_sync_flag,usart_send_flag,anc_report_num; @@ -121,6 +155,7 @@ extern u8 flag_newsecond, tagpos_rec[50], tagpos_send[50],ancidlist_num; uint32_t tagpos_binary; extern u16 ancidlist_rec[20],ancidlist_send[20]; +extern u16 target_time; void IdleTask(void) { @@ -145,17 +180,20 @@ tagpos_rec[i] = 0; } } - + if(target_time>1000) + {target_time-=1000;} + #ifdef USART_INTEGRATE_OUTPUT if(g_com_map[DEV_ROLE]==0&&usart_send_flag) {u16 checksum; usart_send_flag=0; - usart_send_anc[2] = 4;//正常模式 + usart_send_anc[2] = 5;//正常模式 usart_send_anc[3] = anc_report_num*6+2;//正常模式 checksum = Checksum_u16(&usart_send_anc[2],anc_report_num*6+2); memcpy(&usart_send_anc[4+anc_report_num*6],&checksum,2); UART_PushFrame(usart_send_anc,6+anc_report_num*6); anc_report_num=0; } + #endif if(g_com_map[CNT_UPDATE]==1) { uint32_t result = 0; @@ -188,6 +226,10 @@ delay_ms(100); SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader } + if(g_com_map[MAP_SIGN_INDEX]!=0x55AA) + { + SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软复位回到bootloader + } } int main(void) @@ -204,7 +246,7 @@ usart_send[1]=0xAA; usart_send_anc[0]=0x55; usart_send_anc[1]=0xAA; - + //SendComMap(50, 0); while(1) { g_start_sync_flag=0; -- Gitblit v1.9.3