LISHUZUOXUN_yangjiang/uwb_driver_test.py

25 lines
801 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())
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()