Tobi's ubw test branch
Dependencies: mavlink_bridge mbed
Fork of AIT_UWB_Range by
Diff: MM2WayRanging/MM2WayRanging.cpp
- Revision:
- 53:79a72d752ec4
- Parent:
- 52:94688f414dcd
- Child:
- 58:b824bdac7cd8
--- a/MM2WayRanging/MM2WayRanging.cpp Fri Nov 27 16:17:53 2015 +0000 +++ b/MM2WayRanging/MM2WayRanging.cpp Mon Jan 04 12:45:37 2016 +0000 @@ -148,15 +148,17 @@ // pc.printf("Request range %d\r\n", remote_address); dw.enable_irq(); - dw.startRX(); -// pc.printf("Enabled IRQ %d\r\n", remote_address); + + dw.startRX(); +//// pc.printf("Enabled IRQ %d\r\n", remote_address); acknowledgement[remote_address] = false; float time_before = LocalTimer.read(); - -// pc.printf("Sending ping\r\n"); +// +//// pc.printf("Sending ping\r\n"); sendPingFrame(remote_address); - -// pc.printf("Waiting for ack\r\n"); +// + // pc.printf("Waiting for ack\r\n"); + while(!acknowledgement[remote_address] && (LocalTimer.read() < time_before + 0.3f)); // wait for succeeding ranging or timeout roundtriptimes[remote_address] = LocalTimer.read() - time_before;