| | |
| | | Nvic_Init(); |
| | | // Systick_Init(); |
| | | TIM3_Int_Init(); |
| | | Led_Init(); |
| | | |
| | | Beep_Init(); |
| | | DW_GPIO_Init(); |
| | | Uart1_Init(); |
| | | Uart2_Init(); |
| | | Spi_Init(); |
| | | ADC_Configuration(); |
| | | |
| | | Led_Init(); |
| | | GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE); |
| | | } |
| | | u8 anchor_type; |
| | |
| | | { |
| | | g_com_map[COM_INTERVAL]=1000; |
| | | } |
| | | if(module_power>67) |
| | | {module_power=67;} |
| | | 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]=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]=1; |
| | | g_com_map[SYNCBASEID]=1; |
| | | #endif |
| | | OUT485_ENABLE; |
| | | ComMapCheck(); |
| | | g_com_map[VERSION] = 0x0200; |
| | | g_com_map[VERSION] = 0x0211; |
| | | dev_id = g_com_map[DEV_ID]; |
| | | 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]; |
| | | anchor_type = dev_id%3; |
| | | |
| | | |
| | | |
| | | if(g_com_map[DEV_ROLE]) |
| | | { |
| | | printf("æ ç¾ID: %d .\r\n",dev_id); |
| | |
| | | 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]); |
| | |
| | | * |
| | | * @return none |
| | | */ |
| | | extern float GetPressAndHeight(void); |
| | | extern u16 synclost_count; |
| | | extern float Height; |
| | | int32_t intheight; |
| | | void HeatBeat(void) |
| | | { |
| | | { u16 checksum; |
| | | GetPressAndHeight(); |
| | | intheight = Height*100+g_com_map[MAX_REPORT_ANC_NUM]; |
| | | if(synclost_count>5) |
| | | { |
| | | hbsend[6] = 0; |
| | | }else{ |
| | | hbsend[6] = 1; |
| | | } |
| | | memcpy(&hbsend[7],&intheight,4); |
| | | 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; |
| | |
| | | void IdleTask(void) |
| | | { |
| | | |
| | | UART_CheckReceive(); |
| | | UART_CheckSend(); |
| | | UART_CheckReceive(); |
| | | UART_CheckSend(); |
| | | UART2_CheckReceive(); |
| | | |
| | | if(heartbeat_timer>1000) |
| | | { |
| | | heartbeat_timer=0; |
| | | if(g_com_map[HEARTBEAT]&&g_com_map[DEV_ROLE]==0) |
| | | HeatBeat(); |
| | | } |
| | | if(flag_newsecond) |
| | | { |
| | | flag_newsecond=0; |
| | | tagpos_binary=0; |
| | | memcpy(ancidlist_send,ancidlist_rec,ancidlist_num*2); |
| | | ancidlist_num=0; |
| | | for(u8 i=0;i<max_slotpos;i++) |
| | | { |
| | | if(tagpos_rec[i]) |
| | | tagpos_binary|=1<<i; |
| | | tagpos_rec[i] = 0; |
| | | } |
| | | } |
| | | // if(flag_newsecond) |
| | | // { |
| | | // flag_newsecond=0; |
| | | // tagpos_binary=0; |
| | | // memcpy(ancidlist_send,ancidlist_rec,ancidlist_num*2); |
| | | // ancidlist_num=0; |
| | | // for(u8 i=0;i<max_slotpos;i++) |
| | | // { |
| | | // if(tagpos_rec[i]) |
| | | // tagpos_binary|=1<<i; |
| | | // tagpos_rec[i] = 0; |
| | | // } |
| | | // } |
| | | if(target_time>1000) |
| | | {target_time-=1000;} |
| | | #ifdef USART_INTEGRATE_OUTPUT |
| | |
| | | Device_Init(); |
| | | Program_Init(); |
| | | Dw1000_Init(); |
| | | BarInit(); |
| | | delay_ms(10); |
| | | Dw1000_App_Init(); |
| | | /* Loop forever initiating ranging exchanges. */ |
| | |
| | | usart_send[1]=0xAA; |
| | | usart_send_anc[0]=0x55; |
| | | usart_send_anc[1]=0xAA; |
| | | |
| | | //SendComMap(50, 0); |
| | | while(1) |
| | | { |
| | | g_start_sync_flag=0; |