#!/usr/bin/env python3

import spidev
import decawave
import Logger

# Initialize SPI bus
spibus = spidev.SpiDev()
spibus.open(0, 0)
spibus.max_speed_hz = 5000
spibus.mode = 0b00

dwm = decawave.decawave(spibus)
log = Logger.Logger()

while True:
    pos = dwm.pos_get()
    log.log("x = {}, y = {}, z = {}, q = {}".format(pos[0], pos[1], pos[2], pos[3]))