Tobi's ubw test branch

Dependencies:   mavlink_bridge mbed

Fork of AIT_UWB_Range by Benjamin Hepp

main.cpp

Committer:
manumaet
Date:
2014-11-28
Revision:
28:a830131560e8
Parent:
27:71178fdb78e1
Child:
29:019ff388ed76

File content as of revision 28:a830131560e8:

// by Matthias Grob & Manuel Stalder - ETH Zürich - 2015
#include "mbed.h"
#include "PC.h"                                     // Serial Port via USB for debugging with Terminal
#include "DW1000.h"                                 // our DW1000 device driver
#include "MMRanging.h"                              // our self developed raning application

PC          pc(USBTX, USBRX, 921600);               // USB UART Terminal
DW1000      dw(PA_7, PA_6, PA_5, PB_6, PB_9);       // SPI1 on Nucleo Board (MOSI, MISO, SCLK, CS, IRQ)
MMRanging   r(dw);                                  // Ranging class for getting distances and later positions

char message[100] = "";

void callbackRX() {r.callbackRX();}                 // TODO: solve cast from memebr function pointer to function pointer
void callbackTX() {r.callbackTX();}

int main() {
    pc.printf("DecaWave 0.2\r\nup and running!\r\n");  
    dw.setEUI(0xFAEDCD01FAEDCD01);                  // basic methods called to check if we have a working SPI connection
    pc.printf("DEVICE_ID register: 0x%X\r\n", dw.getDeviceID());
    pc.printf("EUI register: %016llX\r\n", dw.getEUI());
    pc.printf("Voltage: %f\r\n", dw.getVoltage());

    r.receiver = true;
    dw.setCallbacks(&callbackRX, &callbackTX);
    
    while(1) {
        for(int j = 0; j < 10; j++)
            if(r.event[j][0] == '!') {
                pc.printf("%s Time: %fus\r\n", r.event[j], r.eventtimes[j]*MMRANGING_TIMEUNIT);
                r.event[j][0] = 'X';
            }    
        if (!r.receiver) {
                r.requestRanging();
                wait(1);
        }
    }
}