| | |
| | | // tyncpoll_time = (tagslotpos--%max_slotpos)*slottime; |
| | | } |
| | | } |
| | | uint8_t pack_length = 0,pack_index = 0,pack_msgtype = 0; |
| | | uint8_t pack_length = 0,pack_index = 0,pack_msgtype = 0, fangchaiconnect_flag; |
| | | void NearPoll(void) |
| | | { |
| | | |
| | |
| | | |
| | | recbase_num=0; |
| | | // motor_state=0; |
| | | fangchaiconnect_flag = !HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_5); |
| | | |
| | | tx_near_msg[BATTARY_IDX] = bat_percent; |
| | | tx_near_msg[BUTTON_IDX] = userkey_state|stationary_flag<<1|gotosleep_flag<<2; |
| | | tx_near_msg[BUTTON_IDX] = userkey_state|stationary_flag<<1|gotosleep_flag<<2|fangchaiconnect_flag<<3; |
| | | tx_near_msg[SEQUENCE_IDX] = frame_seq_nb; |
| | | tx_near_msg[SEQUENCEH_IDX] = (frame_seq_nb++)>>8; |
| | | tx_near_msg[NEARBASENUM_INDEX] = nearbase_num; |
| | |
| | | tag_frequency = REGISTER_FREQUENCY; |
| | | bigslot_num = TOTAL_SLOTNUM/tag_frequency; |
| | | regpoll_count++; |
| | | fangchaiconnect_flag = !HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_5); |
| | | if(regpoll_count%2) |
| | | { |
| | | if(tagslotpos--<2) |