Tobi's ubw test branch
Dependencies: mavlink_bridge mbed
Fork of AIT_UWB_Range by
main.cpp
- Committer:
- manumaet
- Date:
- 2014-12-02
- Revision:
- 32:041dd02e0e3b
- Parent:
- 31:6f76f3d518ac
- Child:
- 33:6ea4c3dd504d
File content as of revision 32:041dd02e0e3b:
// 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()); r.receiver = true; bool senderstart = true; while(1) { for(int j = 0; j < 10; j++) pc.printf("%d ", r.tofs[j]);//*MMRANGING_TIMEUNIT); pc.printf("\r\n"); 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) { if(senderstart) r.requestRanging(); else r.requestTime(); senderstart = !senderstart; } pc.printf("Status: %llX\r\n", dw.getStatus()); wait(2); } }