24 lines
718 B
Python
24 lines
718 B
Python
from Speaker.speak_base import SpeakServer, beep
|
|
from UWB.multi_uwb import *
|
|
|
|
speaker = SpeakServer()
|
|
uwb = UwbController()
|
|
uwb.start()
|
|
print(uwb.set_anchor_status(MODE_POSITION))
|
|
print(uwb.get_anchor_status())
|
|
while True:
|
|
data = uwb.get_data()
|
|
uwb.clear_all()
|
|
if data:
|
|
# print(data)
|
|
tag_id = data[TAG_ID]
|
|
if data[INACTIVE_FREQ] != 100 or data[DYNAMIC_FREQ] != 100:
|
|
uwb.set_tag(tag_id=tag_id, freq=(100, 100, 100))
|
|
# continue
|
|
print(f"设置手环{tag_id}频率！")
|
|
else:
|
|
if uwb.close_tag(tag_id=tag_id):
|
|
# continue
|
|
print(f"手环{tag_id}关闭命令发送成功！")
|
|
# time.sleep(0.1)
|