Tobi's ubw test branch

Dependencies:   mavlink_bridge mbed

Fork of AIT_UWB_Range by Benjamin Hepp

main.cpp

Committer:
manumaet
Date:
2015-02-20
Revision:
36:883de6f9a73b
Parent:
35:95d838d33bf5
Child:
37:40f94c634c3e

File content as of revision 36:883de6f9a73b:

// 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);       // Device driver instanceSPI pins: (MOSI, MISO, SCLK, CS, IRQ)
MMRanging   r(dw);                                  // Ranging class for getting distances and later positions

char message[100] = "";

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());
    pc.printf("Size of Frame: %d\r\n", sizeof(r.TX));
    
    uint16_t setdelay = 32768; // TODO: = 2^15
    dw.writeRegister16(DW1000_TX_ANTD, 0, setdelay);
    pc.printf("Antenna Delay TX: %d\r\n", dw.readRegister16(DW1000_TX_ANTD, 0));
    pc.printf("Antenna Delay RX: %d\r\n", dw.readRegister16(DW1000_LDE_CTRL, 0x1804));
    r.receiver = true;
    if (r.receiver)
        r.address = 1;
    else
        r.address = 0; // sender node has address 0
    pc.printf("Address: %d\r\n", r.address);
    wait(2);
    
    while(1) {
        if (!r.receiver) {                  // Request ranging
            r.requestRanging(1);            // TODO: ask all available nodes!
            wait(0.005);
        }
        
        // Output bar on console
        for(int j = 0; j < 1; j++)
            //pc.printf("%f ", r.tofs[j]*MMRANGING_TIMEUNIT_NS);
            pc.printf("%lld [", r.tofs);
        int dots = r.tofs*70/1400;
        if (abs(dots) < 100000)
            for(int j = 0; j < dots; j++)
                pc.printf("=");
        pc.printf("]\r\n");
        
        #if 1   // Output events for debugging
            for(int j = 0; j < 10; j++)
                if(r.event[j][0] == '!') {
                    pc.printf("%s\r\n", r.event[j]);
                    r.event[j][0] = 'X';
                }
            r.event_i = 0;
        #endif
        pc.printf("Status: %llX\r\n", dw.getStatus());
        pc.printf("Status: %llX\r\n", dw.readRegister40(DW1000_TX_FCTRL, 0));
        
        wait(0.01);
        wait(0.3);
    }
}