| | |
|---|
| | | #include "deca_device_api.h" |
|---|
| | | #include "Flash.h" |
|---|
| | | //#define DEBUG_MODE |
|---|
| | | |
|---|
| | | void Device_Init(void) |
|---|
| | | { |
|---|
| | | RCC_Configuration(); |
|---|
| | |
|---|
| | | uint16_t vel_factor,pos_factor; |
|---|
| | | |
|---|
| | | extern u8 module_power; |
|---|
| | | u16 slottime,max_slotnum,current_slotpos; |
|---|
| | | u16 slottime,max_slotnum,current_slotpos,dist_threshold; |
|---|
| | | void Program_Init(void) |
|---|
| | | {uint16_t i; |
|---|
| | | float temp; |
|---|
| | |
|---|
| | | group_id=g_com_map[GROUP_ID]; |
|---|
| | | vel_factor=g_com_map[FILTER_COEFFICIENT]; |
|---|
| | | pos_factor=g_com_map[FILTER_COEFFICIENT]; |
|---|
| | | dist_threshold = (g_com_map[SPEEDFILTER_THRES]*10)/(1000/g_com_map[COM_INTERVAL]); |
|---|
| | | if(dist_threshold<300) |
|---|
| | | {dist_threshold = 300;} |
|---|
| | | if(dist_threshold>15000) |
|---|
| | | {dist_threshold = 15000;} |
|---|
| | | if(dev_id==0) |
|---|
| | | sync_mainbase=1; |
|---|
| | | module_power = g_com_map[POWER]; |
|---|
| | |
|---|
| | | { |
|---|
| | | module_power=67; |
|---|
| | | } |
|---|
| | | g_com_map[VERSION] = 0x0123; |
|---|
| | | g_com_map[VERSION] = 0x0124; |
|---|
| | | temp=(float)g_com_map[MAX_REPORT_ANC_NUM]*4/3; |
|---|
| | | temp2=g_com_map[MAX_REPORT_ANC_NUM]*4/3; |
|---|
| | | if(temp2<temp) |
|---|
