| | |
|---|
| | | #include <stdio.h> |
|---|
| | | #include "beep.h" |
|---|
| | | #include "modbus.h" |
|---|
| | | |
|---|
| | | #include "CRC.h" |
|---|
| | | /*------------------------------------ Marcos ------------------------------------------*/ |
|---|
| | | /* Inter-ranging delay period, in milliseconds. */ |
|---|
| | | #define RNG_DELAY_MS 100 |
|---|
| | |
|---|
| | | uint16_t rec_ancpos; |
|---|
| | | uint8_t dist_noutenough_count; |
|---|
| | | uint8_t ancdist_hist[11]; |
|---|
| | | |
|---|
| | | uint16_t calCRC; |
|---|
| | | void NearPoll(void) |
|---|
| | | { |
|---|
| | | |
|---|
| | |
|---|
| | | if(para_update) |
|---|
| | | { |
|---|
| | | |
|---|
| | | calCRC = CRC_Compute(rec_remotepara,5); |
|---|
| | | if(memcmp(&calCRC,&rec_remotepara[5],2)==0) |
|---|
| | | { |
|---|
| | | pack_msgtype = rec_remotepara[0]; |
|---|
| | | pack_index = rec_remotepara[1]; |
|---|
| | | pack_length = rec_remotepara[2]; |
|---|
| | |
|---|
| | | } |
|---|
| | | } |
|---|
| | | } |
|---|
| | | } |
|---|
| | | if(get_newdist>=2) |
|---|
| | | { |
|---|
| | | notenoughdist_count = 0; |
|---|
