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())
speaker.add_speak("准备就绪，开始充电啦！")
while True:
    data = uwb.get_data()
    uwb.clear_all()
    if data:
        print(data)
        tag_id = data[TAG_ID]
        if data[INACTIVE_FREQ] != 500:
            print(uwb.set_tag(tag_id=tag_id, freq=(500, 500, 100)))
            beep()
        else:
            if data[BATTERY] == 10:
                print("有手环充满电啦，快来拿走！")
                if uwb.close_tag(tag_id=tag_id):
                    speaker.add_speak("有手环充满电啦，快来拿走！")
                    speaker.wait_4_speak()