Tobi's ubw test branch
Dependencies: mavlink_bridge mbed
Fork of AIT_UWB_Range by
main.cpp@29:019ff388ed76, 2014-11-28 (annotated)
- Committer:
- manumaet
- Date:
- Fri Nov 28 16:45:10 2014 +0000
- Revision:
- 29:019ff388ed76
- Parent:
- 28:a830131560e8
- Child:
- 30:4ecc69d3cf8d
problem with member function pointers solved!
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
manumaet | 24:6f25ba679490 | 1 | // by Matthias Grob & Manuel Stalder - ETH Zürich - 2015 |
manumaet | 0:f50e671ffff7 | 2 | #include "mbed.h" |
manumaet | 26:a65c6f26c458 | 3 | #include "PC.h" // Serial Port via USB for debugging with Terminal |
manumaet | 27:71178fdb78e1 | 4 | #include "DW1000.h" // our DW1000 device driver |
manumaet | 27:71178fdb78e1 | 5 | #include "MMRanging.h" // our self developed raning application |
manumaet | 0:f50e671ffff7 | 6 | |
manumaet | 26:a65c6f26c458 | 7 | PC pc(USBTX, USBRX, 921600); // USB UART Terminal |
manumaet | 26:a65c6f26c458 | 8 | DW1000 dw(PA_7, PA_6, PA_5, PB_6, PB_9); // SPI1 on Nucleo Board (MOSI, MISO, SCLK, CS, IRQ) |
manumaet | 28:a830131560e8 | 9 | MMRanging r(dw); // Ranging class for getting distances and later positions |
manumaet | 14:8041c9b68406 | 10 | |
manumaet | 28:a830131560e8 | 11 | char message[100] = ""; |
manumaet | 6:d5864a1b9e17 | 12 | |
manumaet | 0:f50e671ffff7 | 13 | int main() { |
manumaet | 27:71178fdb78e1 | 14 | pc.printf("DecaWave 0.2\r\nup and running!\r\n"); |
manumaet | 20:257d56530ae1 | 15 | dw.setEUI(0xFAEDCD01FAEDCD01); // basic methods called to check if we have a working SPI connection |
manumaet | 28:a830131560e8 | 16 | pc.printf("DEVICE_ID register: 0x%X\r\n", dw.getDeviceID()); |
manumaet | 28:a830131560e8 | 17 | pc.printf("EUI register: %016llX\r\n", dw.getEUI()); |
manumaet | 28:a830131560e8 | 18 | pc.printf("Voltage: %f\r\n", dw.getVoltage()); |
manumaet | 28:a830131560e8 | 19 | |
manumaet | 28:a830131560e8 | 20 | r.receiver = true; |
manumaet | 5:111f11c95d27 | 21 | |
manumaet | 0:f50e671ffff7 | 22 | while(1) { |
manumaet | 26:a65c6f26c458 | 23 | for(int j = 0; j < 10; j++) |
manumaet | 28:a830131560e8 | 24 | if(r.event[j][0] == '!') { |
manumaet | 28:a830131560e8 | 25 | pc.printf("%s Time: %fus\r\n", r.event[j], r.eventtimes[j]*MMRANGING_TIMEUNIT); |
manumaet | 28:a830131560e8 | 26 | r.event[j][0] = 'X'; |
manumaet | 24:6f25ba679490 | 27 | } |
manumaet | 28:a830131560e8 | 28 | if (!r.receiver) { |
manumaet | 28:a830131560e8 | 29 | r.requestRanging(); |
manumaet | 28:a830131560e8 | 30 | wait(1); |
manumaet | 28:a830131560e8 | 31 | } |
manumaet | 0:f50e671ffff7 | 32 | } |
manumaet | 0:f50e671ffff7 | 33 | } |