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)