Experiment #4: Cooperative Localization Using UWB Ranging Developed by: Cai Haofan & Jiang Linshan, South University of Science and Technology of China Acknowledgements: Dr. Wu Guang Lab Exercise: Cooperative Localization Using UWB Ranging Experiment Objectives: The objectives of this lab are to: 1. Learn how to use UWB Two Way Time of Flight range measurement. 2. Develop a better understanding of cooperative localization. Part 1 - Overview 1.1 Introduction In this lab we will use a pair of Time Domain P410 UWB transceivers (shown in Figure 1) and the Ranging and Communications Module Reconfiguration and Evaluation Tool (RCM-RET) software package to measure the distances between a number of transceivers. We will use the ranging measurements with some additional algorithms to determine the accurate positions of each node (transceiver) in a system of several nodes. Fig. 1: Time Domain P410 transceiver with Broadspec antenna. 1.2 Background 1.2.1 Localization Methods There are many localization methods for wireless ad-hoc or sensor networks and most of them depend on distance or angle estimation. The most common methods for ranging between two nodes are as followed: Time-of-Arrival (ToA) or Time-Difference-of-Arrival (TDoA). This method records the time-of- arrival or time-difference-of-arrival for received signal. Since the propagation speed of signal can be known, the distance can be calculated directly from the propagation time. Received Signal Strength Indication (RSSI) This method measures the power of received signal. The propagation loss can be calculated based on the transmit power known beforehand and then translated into distance information using empirical models. Angle-of-Arrival(AoA) This method measures the angle from which signals are received and then uses geometric relationships to get the distance information. Lab Instructions: Experiment #4 Page 1 Experiment #4: Cooperative Localization Using UWB Ranging Developed by: Cai Haofan & Jiang Linshan, South University of Science and Technology of China Acknowledgements: Dr. Wu Guang Two Way Time of Flight (TWToF) This method measures the total time required to send a signal from one unit and receive an echoed response. By knowing the total two way time of travel, the amount of time required to retransmit the signal, the time when the first arriving energy arrived at both transceivers and the speed of light it is possible to calculate the separation distance between the two transceivers. In this lab, we use two Time Domain P410 UWB transceivers to conduct the ranging experiment. The ranging method used by the P410 is Two Way Time of Flight (TWToF). 1.2.2 Cooperative Multilateration Consider a system consisting of several P410 transceivers separated by some distance. In this system the locations of only some of the transceivers or nodes are known. These nodes are called reference, beacon or anchor nodes. The location of other nodes in the system not known and we will refer to them as unknown nodes. In such a system, it is possible to compute the location of any given unknown node by measuring the distances between it and at least three reference nodes. In an ad-hoc deployment of nodes with a random distribution of reference or anchor node, it is highly possible that a given unknown node might not be visible from three neighboring anchor nodes. When this occurs, an unknown node may attempt to estimate its position by considering use of location information over multiple hops in a process we refer to as collaborative multilateration. If sufficient information is available to form an over-determined set of equations with a unique solution set, a node can estimate its position and the position of additional unknown nodes by solving a set of simultaneous quadratic equations using an optimization algorithm. In this lab we will consider the most basic topology for collaborative multilateration. Figure 2 illustrates the most basic topologies for collaborative multilateration. In Figure 2(a), nodes 5 and 6 are unknown nodes, while nodes 1, 2, 3 and 4 are anchor nodes. In Figure 2(b), nodes A, B and C are unknown nodes, while nodes 1, 2, 3 are anchor nodes. (We will focus on discussing the localization method of nodes 5 and 6 in (a) since unknown nodes in (b) can be localized in a similar way.) Because both Fig. 2: Basic topological structures for collaborative multilateration Lab Instructions: Experiment #4 Page 2 Experiment #4: Cooperative Localization Using UWB Ranging Developed by: Cai Haofan & Jiang Linshan, South University of Science and Technology of China Acknowledgements: Dr. Wu Guang nodes 5 and 6 have three neighbors (degree d = 3) and all the other nodes are anchor nodes with certain location pi(i=1, 2, 3, 4), we can get the range information of d1, d2, d3, d4 and d5 and therefore form a set of quadratic equations (see Formula 1) using these locations and distances information . (1) A unique position estimate for nodes 5 and 6 can be computed by solving these equations using optimization algorithm. The optimization solution is found by taking the minimum mean square estimate of a system of , as the function . (See Formula 2). 1.2.3 Simulated Annealing Algorithm The optimization algorithm we use here is the Simulated Annealing (SA) algorithm. It is a generic probabilistic metaheuristic for the global optimization problem of locating a good approximation to the global optimum of a given function in a large search space. The algorithm models the physical process of heating a material and then slowly lowering the temperature to decrease defects, thus minimizing the system energy. (For more information about the Simulated Annealing algorithm see http://en.wikipedia.org/wiki/Simulated_annealing). In this lab, you will use the SA algorithm to determine the position of the unknown nodes. This algorithm has been implemented in MATLAB as A_algorithm_1.m and SA_algorithm_2.m. Part 2: Localization Experiment 2.1 Required Equipment: Hardware: Laptop, P410 (at least two), measuring tape Software: MATLAB 2.2 SA_algorithm_1.m SA_algorithm_2.m Before the Experiment Install the RCM RET, read the RCM RET User’s Guide and P410 RCM Quick Start Guide carefully before the experiment and pay attention to the use of Calibrate tab, Range tab, Send tab and Logging tab. Lab Instructions: Experiment #4 Page 3 Experiment #4: Cooperative Localization Using UWB Ranging Developed by: Cai Haofan & Jiang Linshan, South University of Science and Technology of China Acknowledgements: Dr. Wu Guang 2.3 1. The Experiment First use the Calibrate tab RCM RET provides to determine and eliminate the antenna delay between two RCMs used for ranging. The P410s will measure the distance between the phase center of the antenna on one unit and the phase center of the antenna on the second unit. (Figure 3 illustrates the location of the phase center.) Phase Center Fig. 3: Location of the antenna phase center. However, the distance measurement also includes the delay from the electronics, through the cable, to the phase center of the antenna. This additional delay is not representative of the distance between the two P410s and needs to be removed through a calibration process. On the Calibrate tab set the Number of Ranges to 100, separate the two P410s with a distance of about 1 to 2 meters and measure the distance between the phase centers of the antennas with a tape measure. Enter this measurement into the Measured Distance (mm) field and click on the Calibrate button. RCM-RET will take 100 measurements, compare with the value measured with the tape measure and compute an antenna delay. When finished, select Write to Flash to save the configuration parameters to the P410 permanent memory. 2. Set up the rectangular coordinate system on an open, flat floor (plane) 3. Choose four points on the floor to be the locations of four anchor nodes 1-4, measure and record the coordinates of these four nodes. Then choose another two points to be unknown nodes and measure these locations. (The distance between every two nodes must be at least 0.1 m since the required operating distance of P410 RCM lies between 0.1m and 354m). 4. Place one node at the first unknown location and the second node at one of the anchor locations such that you are measuring one of the ranges in Figure 2(a). For example, set the nodes such that you are measuring distance d15. Note that only one P410 needs to be connected to the laptop and battery while another one just needs to be connected to the power source. 5. Open RCM-RET, connect to one of the P410s and begin the experiment after successful connection. 6. Select the Logging tab so that range measurements taken in the next step will be logged. Lab Instructions: Experiment #4 Page 4 Experiment #4: Cooperative Localization Using UWB Ranging Developed by: Cai Haofan & Jiang Linshan, South University of Science and Technology of China Acknowledgements: Dr. Wu Guang 7. Select the Send tab, click Range Request, enter the node id of the other P410 into the Responder Id field, click Repeat, click Count, set Count field = 100, set Delay field = 100 and click the Send button. This will take 100 range measurements between the unknown location and an anchor point and log the resultant range measurements to the log file defined in step 6. When the measurements have been taken, close the log. 8. Repeat this test for the other unknown ranges in configuration a (d35, d56, d26, and d46.) Repeat this test for configuration b. 2.4 Lab Report Prepare a report that 1) computes the location of the unknowns using the Simulated Annealing Algorithm for both the a and b configurations then 2) compare the results of the SA algorithm with the actual measured locations. Lab Instructions: Experiment #4 Page 5
© Copyright 2026 Paperzz