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