|
按照用户手册如下部分修改,默认是可以只修改TAG_ID即可,但是默认只有两个slave_tag,如果添加再多slave tag,需要修改MAX_SLAVE_TAG
注意SLAVE_TAG 地址必须从0x01 开始,如果有多个,依次为0x01 0x02 ……
距离信息在TAG 代码如下,默认如果slave_tag 有液晶屏幕,是直接可以显示的。
- static void distance_mange(void)
- {
- {
- int Anchor_Index = 0;
- while(Anchor_Index < ANCHOR_MAX_NUM)
- {
- if(Anthordistance_count[Anchor_Index] > 0 )
- {
- Anthordistance[Anchor_Index] =filter((int)(Anthordistance[Anchor_Index]/Anthordistance_count[Anchor_Index]),Anchor_Index);
- // Anthordistance[Anchor_Index] =(int)(Anthordistance[Anchor_Index]/Anthordistance_count[Anchor_Index]);
- }
- Anchor_Index++;
- }
- }
- compute_angle_send_to_anthor0(Anthordistance[0], Anthordistance[1],Anthordistance[2]);
- if(first_distance == 1)
- {
- first_distance = 0;
- LCD_ClearLines();
- }
- if(Anthordistance_count[0]>0)
- {
- sprintf(dist_str, "an0:%3.2fm", (float)Anthordistance[0]/1000);
- OLED_ShowString(0, 2,dist_str);
- }
- if(Anthordistance_count[1]>0)
- {
- sprintf(dist_str, "an1:%3.2fm", (float)Anthordistance[1]/1000);
- OLED_ShowString(0, 4,dist_str);
- }
- if(Anthordistance_count[2]>0)
- {
- sprintf(dist_str, "an2:%3.2fm", (float)Anthordistance[2]/1000);
- OLED_ShowString(0, 6,dist_str);
- }
- }
复制代码
|
|