| | |
| | | { |
| | | g_com_map[COM_INTERVAL]=100; |
| | | } |
| | | if(dist_threshold<300) |
| | | {dist_threshold = 300;} |
| | | if(dist_threshold>15000) |
| | | {dist_threshold = 15000;} |
| | | } |
| | | u16 JDQ_time; |
| | | u16 g_commap_antdelay; |
| | | int16_t g_commap_antdelay; |
| | | void Program_Init(void) |
| | | { float temp; |
| | | u16 temp2; |
| | |
| | | parameter_init(); |
| | | //deca_sleep(1000); |
| | | HeartBeatInit(); |
| | | Modbus_RegMap(); |
| | | #ifdef DEBUG_MODE |
| | | // g_com_map[DEV_ROLE]=1; |
| | | // g_com_map[DEV_ID]=1; |
| | |
| | | g_com_map[ANC_FLAG]=1; |
| | | save_com_map_to_flash(); |
| | | #endif |
| | | // |
| | | // g_com_map[COM_INTERVAL]=100; |
| | | // g_com_map[MAX_REPORT_ANC_NUM]=10; |
| | | // g_com_map[GROUP_ID]=0; |
| | | // g_com_map[DIST_OFFSET]=-116; |
| | | |
| | | // g_com_map[DEV_ROLE] =0x0; //åºç« |
| | | // |
| | | // g_com_map[ANC_POLL]=1; |
| | | // g_com_map[ALARM_DEV] = 0; |
| | | // g_com_map[ALARM_DISTANCE1] = 0; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[ALARM_DISTANCE2] = 900; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[ALARM_DISTANCE3] = 1400; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[RELAY2_DISTANCE1] = 0; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[RELAY2_DISTANCE2] = 900; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[RELAY2_DISTANCE3] = 1400; //é»è®¤æ¥è¦è·ç¦»50cm |
| | | // g_com_map[WAR_JDQ_TIME] = 1; //1ç§ |
| | | // g_com_map[POWER]=30; |
| | | // g_com_map[SPEEDFILTER_THRES]=10000; |
| | | // g_com_map[FILTER_COEFFICIENT]=40; |
| | | // g_com_map[ANT_LENGTH]=0; |
| | | // g_com_map[NOMOVESLEEP_TIME]=728; |
| | | |
| | | |
| | | OUT485_ENABLE; |
| | | ComMapCheck(); |
| | | g_com_map[VERSION] = 0x0138; |
| | | g_com_map[VERSION] = 1<<8|68; |
| | | FLASH_Read(FLASH_HARDWARE_FLAG, (uint8_t*)&g_com_map[HARDWAREFLAG_INDEX], 16); |
| | | dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); |
| | | g_commap_antdelay = (float)g_com_map[ANT_LENGTH]*5.8; |
| | | if(dist_threshold<300) |
| | | {dist_threshold = 300;} |
| | | if(dist_threshold>15000) |
| | | {dist_threshold = 15000;} |
| | | g_commap_antdelay = g_com_map[ANT_LENGTH]; |
| | | JDQ_time = g_com_map[WAR_JDQ_TIME]*10; |
| | | g_com_map[SW_TYPE] = SW_FANGZHUANG; |
| | | dev_id = g_com_map[DEV_ID]; |
| | |
| | | module_power=67; |
| | | } |
| | | |
| | | // if(g_com_map[DEV_ROLE]) |
| | | // { |
| | | // printf("æ ç¾ID: %d .\r\n",dev_id); |
| | | // printf("é讯é´é: %d ms.\r\n",g_com_map[COM_INTERVAL]); |
| | | // 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]); |
| | | // } |
| | | if(g_com_map[DEV_ROLE]) |
| | | { |
| | | printf("æ ç¾ID: %d .\r\n",dev_id); |
| | | printf("é讯é´é: %d ms.\r\n",g_com_map[COM_INTERVAL]); |
| | | 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]); |
| | | } |
| | | OUT485_DISABLE; |
| | | // printf("DEVICE PAIRID: %d .\r\n",g_com_map[PAIR_ID]); |
| | | // printf("DEVICE ALARM DISTANCE: 1.%d 2.%d 3.%d .\r\n",g_com_map[ALARM_DISTANCE1],g_com_map[ALARM_DISTANCE2],g_com_map[ALARM_DISTANCE3]); |
| | |
| | | |
| | | for(i=0;i<255;i++) |
| | | { |
| | | g_Tagdist[i]=0xffff; |
| | | g_Tagdist[i]=0x1ffff; |
| | | } |
| | | } |
| | | |
| | |
| | | void IdleTask(void) |
| | | { |
| | | |
| | | UART_CheckReceive(); |
| | | UART_CheckReceive(); |
| | | UART_CheckSend(); |
| | | |
| | | if(heartbeat_timer>1000) |
| | |
| | | // NVIC_SystemReset(); |
| | | // } |
| | | // } |
| | | flag_newsecond=0; |
| | | flag_newsecond=0; |
| | | tagpos_binary=0; |
| | | memcpy(ancidlist_send,ancidlist_rec,ancidlist_num*2); |
| | | ancidlist_num=0; |
| | |
| | | { |
| | | SCB->AIRCR = 0X05FA0000|(unsigned int)0x04; //软å¤ä½åå°bootloader |
| | | } |
| | | g_com_map[RELAY1_STATE_INDEX] = READ_RELAY1; |
| | | g_com_map[RELAY2_STATE_INDEX] = READ_RELAY2; |
| | | |
| | | } |
| | | uint8_t at_cmd[3]={0x2B,0x2B,0x2B}; |
| | | uint8_t at_cmd1[2]={0x41,0x54}; |
| | | char at_cmd2[20]={"AT+CAN=500,70,NDTF\r\n"}; //AT+CAN?\r\n |
| | | char at_cmd3[9]={"AT+CAN?\r\n"}; |
| | | char at_cmd4[9]={"AT+EXAT\r\n"}; |
| | | void send_to_ECAN() |
| | | { |
| | | // UART_PushFrame(at_cmd,3); |
| | | // |
| | | // UART_PushFrame(at_cmd1,2); |
| | | //// delay_ms(1); |
| | | // UART_PushFrame((uint8_t*)at_cmd2,20); |
| | | //// delay_ms(1); |
| | | // UART_PushFrame((uint8_t*)at_cmd3,9); |
| | | //// delay_ms(1); |
| | | // UART_PushFrame((uint8_t*)at_cmd4,9); |
| | | printf("+++"); |
| | | delay_ms(20); |
| | | printf("AT"); |
| | | delay_ms(20); |
| | | printf("AT+CAN=500,0,NDTF\r\n"); |
| | | delay_ms(1); |
| | | printf("AT+CAN?\r\n"); |
| | | delay_ms(1); |
| | | printf("AT+EXAT\r\n"); |
| | | } |
| | | |
| | | int main(void) |
| | | { |
| | |
| | | usart_send[1]=0xAA; |
| | | usart_send_anc[0]=0x55; |
| | | usart_send_anc[1]=0xAA; |
| | | |
| | | send_to_ECAN(); |
| | | while(1) |
| | | { |
| | | |
| | | g_start_sync_flag=0; |
| | | if(g_start_send_flag) |
| | | { |