| | |
| | | if(g_com_map[MOTOR_ENABLE]) |
| | | { |
| | | |
| | | if(motor_keeptime>0) |
| | | { |
| | | motor_state = 2; |
| | | }else{ |
| | | motor_state = 0; |
| | | } |
| | | // if(motor_keeptime>0) |
| | | // { |
| | | // motor_state = 2; |
| | | // }else{ |
| | | // motor_state = 0; |
| | | // } |
| | | //motor_state=2; |
| | | switch(motor_state) |
| | | {case 0: |
| | |
| | | hardware_pici= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+2); |
| | | hardware_type= STMFLASH_ReadHalfWord(FLASH_HARDWARE_VERSION_MAP+4); |
| | | //deca_sleep(1000); |
| | | g_com_map[VERSION] = (2<<8)|62; |
| | | g_com_map[VERSION] = (2<<8)|1; |
| | | |
| | | // g_com_map[DEV_ID]=0x7; |
| | | #ifdef DEBUG_MODE |
| | |
| | | // printf("通讯间隔: %d ms.\r\n",g_com_map[COM_INTERVAL]); |
| | | // printf("单次通讯基站数量: %d个.\r\n",g_com_map[MAX_REPORT_ANC_NUM]); |
| | | |
| | | |
| | | printf("固件版本:标签-定位防撞-青岛 V%d.%d. \r\n",g_com_map[VERSION]>>8,g_com_map[VERSION]&0xff); |
| | | // 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]); |
| | | |
| | |
| | | { |
| | | g_com_map[MOTORBEEPER_INDEX] = 2; |
| | | } |
| | | hardware_type = g_com_map[MOTORBEEPER_INDEX]; |
| | | hardware_type = 1;//g_com_map[MOTORBEEPER_INDEX];; |
| | | switch(hardware_type) |
| | | { |
| | | case 1: |
| | |
| | | if(g_start_send_flag&&active_flag) |
| | | { static uint16_t blink_count=0; |
| | | g_start_send_flag = 0; |
| | | static u8 uwbcount =0; |
| | | // GetPressAndTemp(); |
| | | // if(current_count>slot_startcount&¤t_count<slot_startcount+interval_count) |
| | | // { |
| | |
| | | Tag_App(); |
| | | LED_TR_OFF; |
| | | } |
| | | |
| | | __enable_irq(); |
| | | //LED0_BLINK; |
| | | IdleTask(); |
| | |
| | | { |
| | | static uint8_t i=0; |
| | | SystemClock_Config(); |
| | | |
| | | // current_slotnum++; |
| | | // SetNextPollTime(tagslotpos); |
| | | if(tag_frequency>1) |
| | | { |
| | | g_start_send_flag=1; |
| | | }else{ |
| | | if(current_slotpos>=max_slotpos) |
| | | { |
| | | GetRandomPos(); |
| | |
| | | { |
| | | current_sync_sec=0; |
| | | } |
| | | } |
| | | nomove_count+=1/(float)tag_frequency; |
| | | if(motor_keeptime>0) |
| | | { |